/******************************************************************************
 *
 *  Copyright (C) 2008-2014 Broadcom Corporation
 *
 *  Licensed under the Apache License, Version 2.0 (the "License");
 *  you may not use this file except in compliance with the License.
 *  You may obtain a copy of the License at:
 *
 *  http://www.apache.org/licenses/LICENSE-2.0
 *
 *  Unless required by applicable law or agreed to in writing, software
 *  distributed under the License is distributed on an "AS IS" BASIS,
 *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 *  See the License for the specific language governing permissions and
 *  limitations under the License.
 *
 ******************************************************************************/

/******************************************************************************
 *
 *  This file contains functions for BLE GAP.
 *
 ******************************************************************************/

#define LOG_TAG "bt_btm_ble"

#include <string.h>
#include <stdio.h>
#include <stddef.h>

#include "bt_types.h"
#include "bt_utils.h"
#include "btm_ble_api.h"
#include "btm_int.h"
#include "btu.h"
//#include "device/include/controller.h"
#include "gap_api.h"
#include "hcimsgs.h"

#if BLE_INCLUDED == TRUE

#include "btm_ble_int.h"
#include "gatt_int.h"
#include "gattdefs.h"
#include "l2c_int.h"
#include "osi/include/log.h"

#define BTM_BLE_NAME_SHORT                  0x01
#define BTM_BLE_NAME_CMPL                   0x02

#define BTM_BLE_FILTER_TARGET_UNKNOWN       0xff
#define BTM_BLE_POLICY_UNKNOWN              0xff

#define BTM_EXT_BLE_RMT_NAME_TIMEOUT_MS     (30 * 1000)
#define MIN_ADV_LENGTH                       2
#define BTM_VSC_CHIP_CAPABILITY_RSP_LEN_L_RELEASE 9

#ifdef USE_ALARM
    extern fixed_queue_t *btu_general_alarm_queue;
#endif

static tBTM_BLE_VSC_CB cmn_ble_vsc_cb;

#if BLE_VND_INCLUDED == TRUE
    static tBTM_BLE_CTRL_FEATURES_CBACK    *p_ctrl_le_feature_rd_cmpl_cback = NULL;
#endif

/*******************************************************************************
**  Local functions
*******************************************************************************/
static void btm_ble_update_adv_flag(uint8_t flag);
static void btm_ble_process_adv_pkt_cont(BD_ADDR bda, uint8_t addr_type, uint8_t evt_type, uint8_t *p);
uint8_t *btm_ble_build_adv_data(tBTM_BLE_AD_MASK *p_data_mask, uint8_t **p_dst,
                                tBTM_BLE_ADV_DATA *p_data);
static uint8_t btm_set_conn_mode_adv_init_addr(tBTM_BLE_INQ_CB *p_cb,
        BD_ADDR_PTR p_peer_addr_ptr,
        tBLE_ADDR_TYPE *p_peer_addr_type,
        tBLE_ADDR_TYPE *p_own_addr_type);
static void btm_ble_stop_observe(void);
static void btm_ble_fast_adv_timer_timeout(void *data);
static void btm_ble_start_slow_adv(void);
static void btm_ble_inquiry_timer_gap_limited_discovery_timeout(void *data);
static void btm_ble_inquiry_timer_timeout(void *data);
static void btm_ble_observer_timer_timeout(void *data);


#define BTM_BLE_INQ_RESULT          0x01
#define BTM_BLE_OBS_RESULT          0x02
#define BTM_BLE_SEL_CONN_RESULT     0x04

/* LE states combo bit to check */
const uint8_t btm_le_state_combo_tbl[BTM_BLE_STATE_MAX][BTM_BLE_STATE_MAX][2] =
{
    {/* single state support */
        {HCI_SUPP_LE_STATES_CONN_ADV_MASK, HCI_SUPP_LE_STATES_CONN_ADV_OFF},  /* conn_adv */
        {HCI_SUPP_LE_STATES_INIT_MASK, HCI_SUPP_LE_STATES_INIT_OFF}, /* init */
        {HCI_SUPP_LE_STATES_INIT_MASK, HCI_SUPP_LE_STATES_INIT_OFF}, /* master */
        {HCI_SUPP_LE_STATES_SLAVE_MASK, HCI_SUPP_LE_STATES_SLAVE_OFF}, /* slave */
        {0, 0},                   /* todo: lo du dir adv, not covered ? */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_OFF}, /* hi duty dir adv */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_OFF},  /* non connectable adv */
        {HCI_SUPP_LE_STATES_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_OFF},   /*  passive scan */
        {HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_OFF},  /*   active scan */
        {HCI_SUPP_LE_STATES_SCAN_ADV_MASK, HCI_SUPP_LE_STATESSCAN_ADV_OFF}   /* scanable adv */
    },
    {    /* conn_adv =0 */
        {0, 0},                                                                           /* conn_adv */
        {HCI_SUPP_LE_STATES_CONN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_CONN_ADV_INIT_OFF},      /* init: 32 */
        {HCI_SUPP_LE_STATES_CONN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_CONN_ADV_MASTER_OFF},  /* master: 35 */
        {HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_OFF}, /* slave: 38,*/
        {0, 0},                                                                           /* lo du dir adv */
        {0, 0},                                                                            /* hi duty dir adv */
        {0, 0},  /* non connectable adv */
        {HCI_SUPP_LE_STATES_CONN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_CONN_ADV_PASS_SCAN_OFF},   /*  passive scan */
        {HCI_SUPP_LE_STATES_CONN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_CONN_ADV_ACTIVE_SCAN_OFF},  /*   active scan */
        {0, 0}   /* scanable adv */
    },
    {   /* init */
        {HCI_SUPP_LE_STATES_CONN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_CONN_ADV_INIT_OFF},      /* conn_adv: 32 */
        {0, 0},                                                                             /* init */
        {HCI_SUPP_LE_STATES_INIT_MASTER_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_OFF},          /* master 28 */
        {HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_OFF}, /* slave 41 */
        {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_INIT_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_INIT_OFF}, /* lo du dir adv 34 */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_INIT_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_INIT_OFF},     /* hi duty dir adv 33 */
        {HCI_SUPP_LE_STATES_NON_CONN_INIT_MASK, HCI_SUPP_LE_STATES_NON_CONN_INIT_OFF},  /*  non connectable adv */
        {HCI_SUPP_LE_STATES_PASS_SCAN_INIT_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_INIT_OFF},   /* passive scan */
        {HCI_SUPP_LE_STATES_ACTIVE_SCAN_INIT_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_INIT_OFF},  /*  active scan */
        {HCI_SUPP_LE_STATES_SCAN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_INIT_OFF}   /* scanable adv */

    },
    {   /* master */
        {HCI_SUPP_LE_STATES_CONN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_CONN_ADV_MASTER_OFF},  /* conn_adv: 35 */
        {HCI_SUPP_LE_STATES_INIT_MASTER_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_OFF},          /* init 28 */
        {HCI_SUPP_LE_STATES_INIT_MASTER_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_OFF},          /* master 28 */
        {HCI_SUPP_LE_STATES_CONN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_CONN_ADV_INIT_OFF},      /* slave: 32 */
        {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_MASTER_OFF},  /* lo duty cycle adv 37 */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASTER_OFF},   /* hi duty cycle adv 36 */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_MASTER_OFF},  /*  non connectable adv */
        {HCI_SUPP_LE_STATES_PASS_SCAN_MASTER_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_MASTER_OFF},   /*  passive scan */
        {HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASTER_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASTER_OFF},  /*   active scan */
        {HCI_SUPP_LE_STATES_SCAN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_MASTER_OFF}   /*  scanable adv */

    },
    { /* slave */
        {HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_OFF}, /* conn_adv: 38,*/
        {HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_OFF}, /* init 41 */
        {HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_OFF}, /* master 41 */
        {HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_OFF},        /* slave: 38,*/
        {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_SLAVE_OFF},  /* lo duty cycle adv 40 */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_SLAVE_OFF},   /* hi duty cycle adv 39 */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_SLAVE_OFF},  /* non connectable adv */
        {HCI_SUPP_LE_STATES_PASS_SCAN_SLAVE_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_SLAVE_OFF},   /* passive scan */
        {HCI_SUPP_LE_STATES_ACTIVE_SCAN_SLAVE_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_SLAVE_OFF},  /*  active scan */
        {HCI_SUPP_LE_STATES_SCAN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_SLAVE_OFF}   /* scanable adv */

    },
    { /* lo duty cycle adv */
        {0, 0}, /* conn_adv: 38,*/
        {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_INIT_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_INIT_OFF}, /* init 34 */
        {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_MASTER_OFF}, /* master 37 */
        {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_SLAVE_OFF}, /* slave: 40 */
        {0, 0},  /* lo duty cycle adv 40 */
        {0, 0},   /* hi duty cycle adv 39 */
        {0, 0},  /*  non connectable adv */
        {0, 0},   /* TODO: passive scan, not covered? */
        {0, 0},  /* TODO:  active scan, not covered? */
        {0, 0}   /*  scanable adv */
    },
    { /* hi duty cycle adv */
        {0, 0}, /* conn_adv: 38,*/
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_INIT_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_INIT_OFF}, /* init 33 */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASTER_OFF}, /* master 36 */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_SLAVE_OFF},   /* slave: 39*/
        {0, 0},  /* lo duty cycle adv 40 */
        {0, 0},   /* hi duty cycle adv 39 */
        {0, 0},  /* non connectable adv */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_PASS_SCAN_OFF},   /* passive scan */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_ACTIVE_SCAN_OFF},  /* active scan */
        {0, 0}   /* scanable adv */
    },
    { /* non connectable adv */
        {0, 0}, /* conn_adv: */
        {HCI_SUPP_LE_STATES_NON_CONN_INIT_MASK, HCI_SUPP_LE_STATES_NON_CONN_INIT_OFF}, /* init  */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_MASTER_OFF}, /* master  */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_SLAVE_OFF},   /* slave: */
        {0, 0},  /* lo duty cycle adv */
        {0, 0},   /* hi duty cycle adv */
        {0, 0},  /* non connectable adv */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_PASS_SCAN_OFF},   /* passive scan */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_ACTIVE_SCAN_OFF},  /*  active scan */
        {0, 0}   /* scanable adv */
    },
    { /* passive scan */
        {HCI_SUPP_LE_STATES_CONN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_CONN_ADV_PASS_SCAN_OFF}, /* conn_adv: */
        {HCI_SUPP_LE_STATES_PASS_SCAN_INIT_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_INIT_OFF}, /* init  */
        {HCI_SUPP_LE_STATES_PASS_SCAN_MASTER_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_MASTER_OFF}, /* master  */
        {HCI_SUPP_LE_STATES_PASS_SCAN_SLAVE_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_SLAVE_OFF},   /* slave: */
        {0, 0},  /* lo duty cycle adv */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_PASS_SCAN_OFF},   /* hi duty cycle adv */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_PASS_SCAN_OFF},  /*  non connectable adv */
        {0, 0},   /* passive scan */
        {0, 0},  /* active scan */
        {HCI_SUPP_LE_STATES_SCAN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_PASS_SCAN_OFF}   /* scanable adv */
    },
    { /* active scan */
        {HCI_SUPP_LE_STATES_CONN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_CONN_ADV_ACTIVE_SCAN_OFF}, /* conn_adv: */
        {HCI_SUPP_LE_STATES_ACTIVE_SCAN_INIT_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_INIT_OFF}, /* init  */
        {HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASTER_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASTER_OFF}, /* master  */
        {HCI_SUPP_LE_STATES_ACTIVE_SCAN_SLAVE_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_SLAVE_OFF},   /* slave: */
        {0, 0},  /* lo duty cycle adv */
        {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_ACTIVE_SCAN_OFF},   /* hi duty cycle adv */
        {HCI_SUPP_LE_STATES_NON_CONN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_ACTIVE_SCAN_OFF},  /*  non connectable adv */
        {0, 0},   /* TODO: passive scan */
        {0, 0},  /* TODO:  active scan */
        {HCI_SUPP_LE_STATES_SCAN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_ACTIVE_SCAN_OFF}   /*  scanable adv */
    },
    { /* scanable adv */
        {0, 0}, /* conn_adv: */
        {HCI_SUPP_LE_STATES_SCAN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_INIT_OFF}, /* init  */
        {HCI_SUPP_LE_STATES_SCAN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_MASTER_OFF}, /* master  */
        {HCI_SUPP_LE_STATES_SCAN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_SLAVE_OFF},   /* slave: */
        {0, 0},  /* lo duty cycle adv */
        {0, 0},   /* hi duty cycle adv */
        {0, 0},  /* non connectable adv */
        {HCI_SUPP_LE_STATES_SCAN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_PASS_SCAN_OFF},   /*  passive scan */
        {HCI_SUPP_LE_STATES_SCAN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_ACTIVE_SCAN_OFF},  /*  active scan */
        {0, 0}   /* scanable adv */
    }

};
/* check LE combo state supported */
#define BTM_LE_STATES_SUPPORTED(x, y, z)      ((x)[(z)] & (y))

/*******************************************************************************
**
** Function         BTM_BleUpdateAdvWhitelist
**
** Description      Add or remove device from advertising white list
**
** Returns          void
**
*******************************************************************************/
uint8_t BTM_BleUpdateAdvWhitelist(uint8_t add_remove, BD_ADDR remote_bda)
{
    UNUSED(add_remove);
    UNUSED(remote_bda);
    return FALSE;
}

/*******************************************************************************
**
** Function         BTM_BleUpdateAdvFilterPolicy
**
** Description      This function update the filter policy of advertiser.
**
** Parameter        adv_policy: advertising filter policy
**
** Return           void
*******************************************************************************/
void BTM_BleUpdateAdvFilterPolicy(tBTM_BLE_AFP adv_policy)
{
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    tBLE_ADDR_TYPE   init_addr_type = BLE_ADDR_PUBLIC;
    BD_ADDR          p_addr_ptr = {0};
    uint8_t            adv_mode = p_cb->adv_mode;
    BTM_TRACE_EVENT("BTM_BleUpdateAdvFilterPolicy");

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return;
    }

    if(p_cb->afp != adv_policy)
    {
        p_cb->afp = adv_policy;
        /* if adv active, stop and restart */
        btm_ble_stop_adv();

        if(p_cb->connectable_mode & BTM_BLE_CONNECTABLE)
            p_cb->evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &init_addr_type,
                             &p_cb->adv_addr_type);

        btsnd_hcic_ble_write_adv_params((uint16_t)(p_cb->adv_interval_min ? p_cb->adv_interval_min :
                                        BTM_BLE_GAP_ADV_SLOW_INT),
                                        (uint16_t)(p_cb->adv_interval_max ? p_cb->adv_interval_max :
                                                BTM_BLE_GAP_ADV_SLOW_INT),
                                        p_cb->evt_type,
                                        p_cb->adv_addr_type,
                                        init_addr_type,
                                        p_addr_ptr,
                                        p_cb->adv_chnl_map,
                                        p_cb->afp);

        if(adv_mode == BTM_BLE_ADV_ENABLE)
        {
            btm_ble_start_adv();
        }
    }
}

/*******************************************************************************
**
** Function         btm_ble_send_extended_scan_params
**
** Description      This function sends out the extended scan parameters command to the controller
**
** Parameters       scan_type - Scan type
**                  scan_int - Scan interval
**                  scan_win - Scan window
**                  addr_type_own - Own address type
**                  scan_filter_policy - Scan filter policy
**
** Returns          TRUE or FALSE
**
*******************************************************************************/
uint8_t btm_ble_send_extended_scan_params(uint8_t scan_type, uint32_t scan_int,
        uint32_t scan_win, uint8_t addr_type_own,
        uint8_t scan_filter_policy)
{
    uint8_t scan_param[HCIC_PARAM_SIZE_BLE_WRITE_EXTENDED_SCAN_PARAM];
    uint8_t *pp_scan = scan_param;
    wm_memset(scan_param, 0, HCIC_PARAM_SIZE_BLE_WRITE_EXTENDED_SCAN_PARAM);
    UINT8_TO_STREAM(pp_scan, scan_type);
    UINT32_TO_STREAM(pp_scan, scan_int);
    UINT32_TO_STREAM(pp_scan, scan_win);
    UINT8_TO_STREAM(pp_scan, addr_type_own);
    UINT8_TO_STREAM(pp_scan, scan_filter_policy);
    BTM_TRACE_DEBUG("%s, %d, %d", __func__, scan_int, scan_win);

    if((BTM_VendorSpecificCommand(HCI_BLE_EXTENDED_SCAN_PARAMS_OCF,
                                  HCIC_PARAM_SIZE_BLE_WRITE_EXTENDED_SCAN_PARAM, scan_param, NULL)) != BTM_SUCCESS)
    {
        BTM_TRACE_ERROR("%s error sending extended scan parameters", __func__);
        return FALSE;
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         BTM_BleObserve
**
** Description      This procedure keep the device listening for advertising
**                  events from a broadcast device.
**
** Parameters       start: start or stop observe.
**                  white_list: use white list in observer mode or not.
**
** Returns          void
**
*******************************************************************************/
tBTM_STATUS BTM_BleObserve(uint8_t start, uint8_t duration,
                           tBTM_INQ_RESULTS_CB *p_results_cb, tBTM_CMPL_CB *p_cmpl_cb)
{
    tBTM_BLE_INQ_CB *p_inq = &btm_cb.ble_ctr_cb.inq_var;
    tBTM_STATUS status = BTM_WRONG_MODE;
    uint32_t scan_interval = !p_inq->scan_interval ? BTM_BLE_GAP_DISC_SCAN_INT : p_inq->scan_interval;
    uint32_t scan_window = !p_inq->scan_window ? BTM_BLE_GAP_DISC_SCAN_WIN : p_inq->scan_window;
    BTM_TRACE_EVENT("%s : scan_type:%d, %d, %d", __func__, btm_cb.btm_inq_vars.scan_type,
                    p_inq->scan_interval, p_inq->scan_window);

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return BTM_ILLEGAL_VALUE;
    }

    if(start)
    {
        /* shared inquiry database, do not allow observe if any inquiry is active */
        if(BTM_BLE_IS_OBS_ACTIVE(btm_cb.ble_ctr_cb.scan_activity))
        {
            BTM_TRACE_ERROR("%s Observe Already Active", __func__);
            return status;
        }

        btm_cb.ble_ctr_cb.p_obs_results_cb = p_results_cb;
        btm_cb.ble_ctr_cb.p_obs_cmpl_cb = p_cmpl_cb;
        status = BTM_CMD_STARTED;

        /* scan is not started */
        if(!BTM_BLE_IS_SCAN_ACTIVE(btm_cb.ble_ctr_cb.scan_activity))
        {
            /* allow config of scan type */
            p_inq->scan_type = (p_inq->scan_type == BTM_BLE_SCAN_MODE_NONE) ?
                               BTM_BLE_SCAN_MODE_ACTI : p_inq->scan_type;
            /* assume observe always not using white list */
            #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE)
            /* enable resolving list */
            btm_ble_enable_resolving_list_for_platform(BTM_BLE_RL_SCAN);
            #endif

            if(cmn_ble_vsc_cb.extended_scan_support == 0)
            {
                btsnd_hcic_ble_set_scan_params(p_inq->scan_type, (uint16_t)scan_interval,
                                               (uint16_t)scan_window,
                                               btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type,
                                               BTM_BLE_DEFAULT_SFP);
            }
            else
            {
                btm_ble_send_extended_scan_params(p_inq->scan_type, scan_interval, scan_window,
                                                  btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type,
                                                  BTM_BLE_DEFAULT_SFP);
            }

            p_inq->scan_duplicate_filter = BTM_BLE_DUPLICATE_DISABLE;
            status = btm_ble_start_scan();
        }

        if(status == BTM_CMD_STARTED)
        {
            btm_cb.ble_ctr_cb.scan_activity |= BTM_LE_OBSERVE_ACTIVE;

            if(duration != 0)
            {
                /* start observer timer */
                
                #ifdef USE_ALARM
				uint64_t duration_ms = duration * 1000;
                alarm_set_on_queue(btm_cb.ble_ctr_cb.observer_timer,
                                   duration_ms, btm_ble_observer_timer_timeout,
                                   NULL, btu_general_alarm_queue);
                #else
                btm_cb.ble_ctr_cb.observer_timer.p_cback = (TIMER_CBACK *)&btm_ble_observer_timer_timeout;
                btm_cb.ble_ctr_cb.observer_timer.param = (TIMER_PARAM_TYPE)NULL;
                btu_start_timer(&btm_cb.ble_ctr_cb.observer_timer, BTU_TTYPE_BLE_OBSERVE, duration);
                #endif
            }
        }
    }
    else
        if(BTM_BLE_IS_OBS_ACTIVE(btm_cb.ble_ctr_cb.scan_activity))
        {
            status = BTM_CMD_STARTED;
            btm_ble_stop_observe();
        }
        else
        {
            BTM_TRACE_ERROR("%s Observe not active", __func__);
        }

    return status;
}
static void btm_ble_broadcast_timer_timeout(void *data)
{
    tBTM_STATUS status = BTM_NO_RESOURCES;
    status = btm_ble_stop_adv();
#if BLE_PRIVACY_SPT == TRUE
    btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE);
#endif

}

/*******************************************************************************
**
** Function         BTM_BleBroadcast
**
** Description      This function is to start or stop broadcasting.
**
** Parameters       start: start or stop broadcasting.
**
** Returns          status.
**
*******************************************************************************/
tBTM_STATUS BTM_BleBroadcast(uint8_t start, uint32_t duration)
{
    tBTM_STATUS status = BTM_NO_RESOURCES;
    tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb;
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    //uint8_t evt_type = p_cb->scan_rsp ? BTM_BLE_DISCOVER_EVT : BTM_BLE_NON_CONNECT_EVT;

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return BTM_ILLEGAL_VALUE;
    }

    if(start && p_cb->adv_mode == BTM_BLE_ADV_DISABLE)
    {
        /* update adv params */
        if(!btsnd_hcic_ble_write_adv_params((uint16_t)(p_cb->adv_interval_min ? p_cb->adv_interval_min :
                                            BTM_BLE_GAP_ADV_INT),
                                            (uint16_t)(p_cb->adv_interval_max ? p_cb->adv_interval_max :
                                                    BTM_BLE_GAP_ADV_INT),
                                            p_cb->evt_type,
                                            p_addr_cb->own_addr_type,
                                            p_cb->direct_bda.type,
                                            p_cb->direct_bda.bda,
                                            p_cb->adv_chnl_map,
                                            p_cb->afp))
        {
            status = BTM_NO_RESOURCES;
        }
        else
        {
            //p_cb->evt_type = evt_type;
        }

        status = btm_ble_start_adv();

        if((status == BTM_SUCCESS) && (duration !=0))
        {
            p_cb->broadcast_adv_timer_on = TRUE;
            p_cb->ble_broadcast_timer.p_cback = (TIMER_CBACK *)&btm_ble_broadcast_timer_timeout;
            p_cb->ble_broadcast_timer.param = (TIMER_PARAM_TYPE)NULL;
            btu_start_timer(&p_cb->ble_broadcast_timer, BTU_TTYPE_BLE_GAP_BROADCAST, duration);
        }
        
    }
    else
        if(!start)
        {
            if(p_cb->broadcast_adv_timer_on)
            {
              btu_stop_timer(&p_cb->ble_broadcast_timer);  
            }
            
            status = btm_ble_stop_adv();
            #if BLE_PRIVACY_SPT == TRUE
            btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE);
            #endif
            
        }
        else
        {
            status = BTM_WRONG_MODE;
            BTM_TRACE_ERROR("Can not %s Broadcast, device %s in Broadcast mode",
                            (start ? "Start" : "Stop"), (start ? "already" : "not"));
        }

    return status;
}

#if BLE_VND_INCLUDED == TRUE
/*******************************************************************************
**
** Function         btm_vsc_brcm_features_complete
**
** Description      Command Complete callback for HCI_BLE_VENDOR_CAP_OCF
**
** Returns          void
**
*******************************************************************************/
static void btm_ble_vendor_capability_vsc_cmpl_cback(tBTM_VSC_CMPL *p_vcs_cplt_params)
{
    uint8_t status = 0xFF;
    uint8_t *p;
    BTM_TRACE_DEBUG("%s", __func__);

    /* Check status of command complete event */
    if((p_vcs_cplt_params->opcode == HCI_BLE_VENDOR_CAP_OCF) &&
            (p_vcs_cplt_params->param_len > 0))
    {
        p = p_vcs_cplt_params->p_param_buf;
        STREAM_TO_UINT8(status, p);
    }

    if(status == HCI_SUCCESS)
    {
        STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.adv_inst_max, p);
        STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.rpa_offloading, p);
        STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.tot_scan_results_strg, p);
        STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.max_irk_list_sz, p);
        STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.filter_support, p);
        STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.max_filter, p);
        STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.energy_support, p);

        if(p_vcs_cplt_params->param_len > BTM_VSC_CHIP_CAPABILITY_RSP_LEN_L_RELEASE)
        {
            STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.version_supported, p);
        }
        else
        {
            btm_cb.cmn_ble_vsc_cb.version_supported = BTM_VSC_CHIP_CAPABILITY_L_VERSION;
        }

        if(btm_cb.cmn_ble_vsc_cb.version_supported >= BTM_VSC_CHIP_CAPABILITY_M_VERSION)
        {
            STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.total_trackable_advertisers, p);
            STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.extended_scan_support, p);
            STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.debug_logging_supported, p);
        }

        btm_cb.cmn_ble_vsc_cb.values_read = TRUE;
    }

    BTM_TRACE_DEBUG("%s: stat=%d, irk=%d, ADV ins:%d, rpa=%d, ener=%d, ext_scan=%d",
                    __func__, status, btm_cb.cmn_ble_vsc_cb.max_irk_list_sz,
                    btm_cb.cmn_ble_vsc_cb.adv_inst_max, btm_cb.cmn_ble_vsc_cb.rpa_offloading,
                    btm_cb.cmn_ble_vsc_cb.energy_support, btm_cb.cmn_ble_vsc_cb.extended_scan_support);

    if(BTM_BleMaxMultiAdvInstanceCount() > 0)
    {
        btm_ble_multi_adv_init();
    }

    if(btm_cb.cmn_ble_vsc_cb.max_filter > 0)
    {
        btm_ble_adv_filter_init();
    }

    #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE)

    /* VS capability included and non-4.2 device */
    if(btm_cb.cmn_ble_vsc_cb.max_irk_list_sz > 0 &&
            /*controller_get_interface()->get_ble_resolving_list_max_size() == 0*/
            btm_cb.devcb.ble_resolving_list_max_size == 0)
    {
        btm_ble_resolving_list_init(btm_cb.cmn_ble_vsc_cb.max_irk_list_sz);
    }

    #endif  /* (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE) */

    if(btm_cb.cmn_ble_vsc_cb.tot_scan_results_strg > 0)
    {
        btm_ble_batchscan_init();
    }

    if(p_ctrl_le_feature_rd_cmpl_cback != NULL)
    {
        p_ctrl_le_feature_rd_cmpl_cback(status);
    }
}
#endif  /* BLE_VND_INCLUDED == TRUE */

/*******************************************************************************
**
** Function         BTM_BleGetVendorCapabilities
**
** Description      This function reads local LE features
**
** Parameters       p_cmn_vsc_cb : Locala LE capability structure
**
** Returns          void
**
*******************************************************************************/
extern void BTM_BleGetVendorCapabilities(tBTM_BLE_VSC_CB *p_cmn_vsc_cb)
{
    BTM_TRACE_DEBUG("BTM_BleGetVendorCapabilities");

    if(NULL != p_cmn_vsc_cb)
    {
        *p_cmn_vsc_cb = btm_cb.cmn_ble_vsc_cb;
    }
}

/******************************************************************************
**
** Function         BTM_BleReadControllerFeatures
**
** Description      Reads BLE specific controller features
**
** Parameters:      tBTM_BLE_CTRL_FEATURES_CBACK : Callback to notify when features are read
**
** Returns          void
**
*******************************************************************************/
extern void BTM_BleReadControllerFeatures(tBTM_BLE_CTRL_FEATURES_CBACK  *p_vsc_cback)
{
    if(TRUE == btm_cb.cmn_ble_vsc_cb.values_read)
    {
        return;
    }

    #if BLE_VND_INCLUDED == TRUE
    BTM_TRACE_DEBUG("BTM_BleReadControllerFeatures");
    p_ctrl_le_feature_rd_cmpl_cback = p_vsc_cback;

    if(BTM_VendorSpecificCommand(HCI_BLE_VENDOR_CAP_OCF,
                                 0,
                                 NULL,
                                 btm_ble_vendor_capability_vsc_cmpl_cback)
            != BTM_CMD_STARTED)
    {
        BTM_TRACE_ERROR("LE Get_Vendor Capabilities Command Failed.");
    }

    #else
    UNUSED(p_vsc_cback);
    #endif
    return ;
}

/*******************************************************************************
**
** Function         BTM_BleEnableMixedPrivacyMode
**
** Description      This function is called to enabled Mixed mode if privacy 1.2
**                  is applicable in controller.
**
** Parameters       mixed_on:  mixed mode to be used or not.
**
** Returns          void
**
*******************************************************************************/
void BTM_BleEnableMixedPrivacyMode(uint8_t mixed_on)
{
    #if BLE_PRIVACY_SPT == TRUE
    btm_cb.ble_ctr_cb.mixed_mode = mixed_on;
    /* TODO: send VSC to enabled mixed mode */
    #endif
}

/*******************************************************************************
**
** Function         BTM_BleConfigPrivacy
**
** Description      This function is called to enable or disable the privacy in
**                   LE channel of the local device.
**
** Parameters       privacy_mode:  privacy mode on or off.
**
** Returns          uint8_t privacy mode set success; otherwise failed.
**
*******************************************************************************/
uint8_t BTM_BleConfigPrivacy(uint8_t privacy_mode)
{
    #if BLE_PRIVACY_SPT == TRUE
    tBTM_BLE_CB  *p_cb = &btm_cb.ble_ctr_cb;
    BTM_TRACE_EVENT("%s", __func__);

    /* if LE is not supported, return error */
    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return FALSE;
    }

    uint8_t addr_resolution = 0;

    if(!privacy_mode)   /* if privacy disabled, always use public address */
    {
        p_cb->addr_mgnt_cb.own_addr_type = BLE_ADDR_PUBLIC;
        p_cb->privacy_mode = BTM_PRIVACY_NONE;
    }
    else /* privacy is turned on*/
    {
        /* always set host random address, used when privacy 1.1 or priavcy 1.2 is disabled */
        p_cb->addr_mgnt_cb.own_addr_type = BLE_ADDR_RANDOM;
        btm_gen_resolvable_private_addr((void *)btm_gen_resolve_paddr_low);
#if BLE_VND_INCLUDED == TRUE
        if(BTM_BleMaxMultiAdvInstanceCount() > 0)
        {
            btm_ble_multi_adv_enb_privacy(privacy_mode);
        }
#endif        

        /* 4.2 controller only allow privacy 1.2 or mixed mode, resolvable private address in controller */
        if(HCI_LE_ENHANCED_PRIVACY_SUPPORTED(btm_cb.devcb.local_le_features))
        {
            addr_resolution = 1;
            /* check vendor specific capability */
            p_cb->privacy_mode = btm_cb.ble_ctr_cb.mixed_mode ? BTM_PRIVACY_MIXED : BTM_PRIVACY_1_2;
        }
        else  /* 4.1/4.0 controller */
        {
            p_cb->privacy_mode = BTM_PRIVACY_1_1;
        }
    }

    GAP_BleAttrDBUpdate(GATT_UUID_GAP_CENTRAL_ADDR_RESOL, (tGAP_BLE_ATTR_VALUE *)&addr_resolution);
    return TRUE;
    #else
    return FALSE;
    #endif
}

/*******************************************************************************
**
** Function          BTM_BleMaxMultiAdvInstanceCount
**
** Description        Returns max number of multi adv instances supported by controller
**
** Returns          Max multi adv instance count
**
*******************************************************************************/
extern uint8_t  BTM_BleMaxMultiAdvInstanceCount(void)
{
    return btm_cb.cmn_ble_vsc_cb.adv_inst_max < BTM_BLE_MULTI_ADV_MAX ?
           btm_cb.cmn_ble_vsc_cb.adv_inst_max : BTM_BLE_MULTI_ADV_MAX;
}

#if BLE_PRIVACY_SPT == TRUE
/*******************************************************************************
**
** Function         btm_ble_resolve_random_addr_on_adv
**
** Description      resolve random address complete callback.
**
** Returns          void
**
*******************************************************************************/
static void btm_ble_resolve_random_addr_on_adv(void *p_rec, void *p)
{
    tBTM_SEC_DEV_REC    *match_rec = (tBTM_SEC_DEV_REC *) p_rec;
    uint8_t       addr_type = BLE_ADDR_RANDOM;
    BD_ADDR     bda;
    uint8_t       *pp = (uint8_t *)p + 1;
    uint8_t           evt_type;
    BTM_TRACE_EVENT("btm_ble_resolve_random_addr_on_adv ");
    STREAM_TO_UINT8(evt_type, pp);
    STREAM_TO_UINT8(addr_type, pp);
    STREAM_TO_BDADDR(bda, pp);

    if(match_rec)
    {
        BTM_TRACE_DEBUG("Random match");
        match_rec->ble.active_addr_type = BTM_BLE_ADDR_RRA;
        wm_memcpy(match_rec->ble.cur_rand_addr, bda, BD_ADDR_LEN);

        if(btm_ble_init_pseudo_addr(match_rec, bda))
        {
            wm_memcpy(bda, match_rec->bd_addr, BD_ADDR_LEN);
        }
        else
        {
            // Assign the original address to be the current report address
            wm_memcpy(bda, match_rec->ble.pseudo_addr, BD_ADDR_LEN);
        }
    }

    btm_ble_process_adv_pkt_cont(bda, addr_type, evt_type, pp);
    return;
}
#endif

/*******************************************************************************
**
** Function         BTM_BleLocalPrivacyEnabled
**
** Description        Checks if local device supports private address
**
** Returns          Return TRUE if local privacy is enabled else FALSE
**
*******************************************************************************/
uint8_t BTM_BleLocalPrivacyEnabled(void)
{
    #if BLE_PRIVACY_SPT == TRUE
    return (btm_cb.ble_ctr_cb.privacy_mode != BTM_PRIVACY_NONE);
    #else
    return false;
    #endif
}

/*******************************************************************************
**
** Function         BTM_BleSetBgConnType
**
** Description      This function is called to set BLE connectable mode for a
**                  peripheral device.
**
** Parameters       bg_conn_type: it can be auto connection, or selective connection.
**                  p_select_cback: callback function when selective connection procedure
**                              is being used.
**
** Returns          void
**
*******************************************************************************/
uint8_t BTM_BleSetBgConnType(tBTM_BLE_CONN_TYPE   bg_conn_type,
                             tBTM_BLE_SEL_CBACK   *p_select_cback)
{
    uint8_t started = TRUE;
    BTM_TRACE_EVENT("BTM_BleSetBgConnType ");

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return FALSE;
    }

    if(btm_cb.ble_ctr_cb.bg_conn_type != bg_conn_type)
    {
        switch(bg_conn_type)
        {
            case BTM_BLE_CONN_AUTO:
                btm_ble_start_auto_conn(TRUE);
                break;

            case BTM_BLE_CONN_SELECTIVE:
                if(btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_AUTO)
                {
                    btm_ble_start_auto_conn(FALSE);
                }

                btm_ble_start_select_conn(TRUE, p_select_cback);
                break;

            case BTM_BLE_CONN_NONE:
                if(btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_AUTO)
                {
                    btm_ble_start_auto_conn(FALSE);
                }
                else
                    if(btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_SELECTIVE)
                    {
                        btm_ble_start_select_conn(FALSE, NULL);
                    }

                started = TRUE;
                break;

            default:
                BTM_TRACE_ERROR("invalid bg connection type : %d ", bg_conn_type);
                started = FALSE;
                break;
        }

        if(started)
        {
            btm_cb.ble_ctr_cb.bg_conn_type = bg_conn_type;
        }
    }

    return started;
}

/*******************************************************************************
**
** Function         BTM_BleClearBgConnDev
**
** Description      This function is called to clear the whitelist,
**                  end any pending whitelist connections,
*                   and reset the local bg device list.
**
** Parameters       void
**
** Returns          void
**
*******************************************************************************/
void BTM_BleClearBgConnDev(void)
{
    btm_ble_start_auto_conn(FALSE);
    btm_ble_clear_white_list();
    gatt_reset_bgdev_list();
}

/*******************************************************************************
**
** Function         BTM_BleUpdateBgConnDev
**
** Description      This function is called to add or remove a device into/from
**                  background connection procedure. The background connection
*                   procedure is decided by the background connection type, it can be
*                   auto connection, or selective connection.
**
** Parameters       add_remove: TRUE to add; FALSE to remove.
**                  remote_bda: device address to add/remove.
**
** Returns          void
**
*******************************************************************************/
uint8_t BTM_BleUpdateBgConnDev(uint8_t add_remove, BD_ADDR   remote_bda)
{
    BTM_TRACE_EVENT("%s() add=%d", __func__, add_remove);
    return btm_update_dev_to_white_list(add_remove, remote_bda);
}

/*******************************************************************************
**
** Function         BTM_BleSetConnectableMode
**
** Description      This function is called to set BLE connectable mode for a
**                  peripheral device.
**
** Parameters       conn_mode:  directed connectable mode, or non-directed.It can
**                              be BTM_BLE_CONNECT_EVT, BTM_BLE_CONNECT_DIR_EVT or
**                              BTM_BLE_CONNECT_LO_DUTY_DIR_EVT
**
** Returns          BTM_ILLEGAL_VALUE if controller does not support BLE.
**                  BTM_SUCCESS is status set successfully; otherwise failure.
**
*******************************************************************************/
tBTM_STATUS BTM_BleSetConnectableMode(tBTM_BLE_CONN_MODE connectable_mode)
{
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    BTM_TRACE_EVENT("BTM_BleSetConnMode connectable_mode = %d ", connectable_mode);

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return BTM_ILLEGAL_VALUE;
    }

    p_cb->directed_conn = connectable_mode;
    return btm_ble_set_connectability(p_cb->connectable_mode);
}

#if BLE_PRIVACY_SPT == TRUE
static uint8_t is_resolving_list_bit_set(void *data, void *context)
{
    tBTM_SEC_DEV_REC *p_dev_rec = data;

    if((p_dev_rec->ble.in_controller_list & BTM_RESOLVING_LIST_BIT) != 0)
    {
        return false;
    }

    return true;
}
#endif

/*******************************************************************************
**
** Function         btm_set_conn_mode_adv_init_addr
**
** Description      set initator address type and local address type based on adv
**                  mode.
**
**
*******************************************************************************/
static uint8_t btm_set_conn_mode_adv_init_addr(tBTM_BLE_INQ_CB *p_cb,
        BD_ADDR_PTR p_peer_addr_ptr,
        tBLE_ADDR_TYPE *p_peer_addr_type,
        tBLE_ADDR_TYPE *p_own_addr_type)
{
    uint8_t evt_type;
    #if BLE_PRIVACY_SPT == TRUE
    tBTM_SEC_DEV_REC *p_dev_rec;
    #endif
    evt_type = (p_cb->connectable_mode == BTM_BLE_NON_CONNECTABLE) ? \
               ((p_cb->scan_rsp) ? BTM_BLE_DISCOVER_EVT : BTM_BLE_NON_CONNECT_EVT)\
               : BTM_BLE_CONNECT_EVT;

    if(evt_type == BTM_BLE_CONNECT_EVT)
    {
        evt_type = p_cb->directed_conn;

        if(p_cb->directed_conn == BTM_BLE_CONNECT_DIR_EVT ||
                p_cb->directed_conn == BTM_BLE_CONNECT_LO_DUTY_DIR_EVT)
        {
            #if BLE_PRIVACY_SPT == TRUE

            /* for privacy 1.2, convert peer address as static, own address set as ID addr */
            if(btm_cb.ble_ctr_cb.privacy_mode ==  BTM_PRIVACY_1_2 ||
                    btm_cb.ble_ctr_cb.privacy_mode ==  BTM_PRIVACY_MIXED)
            {
                /* only do so for bonded device */
                if((p_dev_rec = btm_find_or_alloc_dev(p_cb->direct_bda.bda)) != NULL &&
                        p_dev_rec->ble.in_controller_list & BTM_RESOLVING_LIST_BIT)
                {
                    btm_ble_enable_resolving_list(BTM_BLE_RL_ADV);
                    wm_memcpy(p_peer_addr_ptr, p_dev_rec->ble.static_addr, BD_ADDR_LEN);
                    *p_peer_addr_type = p_dev_rec->ble.static_addr_type;
                    *p_own_addr_type = BLE_ADDR_RANDOM_ID;
                    return evt_type;
                }
                /* otherwise fall though as normal directed adv */
                else
                {
                    btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE);
                }
            }

            #endif
            /* direct adv mode does not have privacy, if privacy is not enabled  */
            *p_peer_addr_type  = p_cb->direct_bda.type;
            wm_memcpy(p_peer_addr_ptr, p_cb->direct_bda.bda, BD_ADDR_LEN);
            return evt_type;
        }
    }

    /* undirect adv mode or non-connectable mode*/
    #if BLE_PRIVACY_SPT == TRUE

    /* when privacy 1.2 privacy only mode is used, or mixed mode */
    if((btm_cb.ble_ctr_cb.privacy_mode ==  BTM_PRIVACY_1_2 && p_cb->afp != AP_SCAN_CONN_ALL) ||
            btm_cb.ble_ctr_cb.privacy_mode ==  BTM_PRIVACY_MIXED)
    {
        list_node_t *n = list_foreach(btm_cb.sec_dev_rec, is_resolving_list_bit_set, NULL);

        if(n)
        {
            /* if enhanced privacy is required, set Identity address and matching IRK peer */
            tBTM_SEC_DEV_REC  *p_dev_rec = list_node(n);
            wm_memcpy(p_peer_addr_ptr, p_dev_rec->ble.static_addr, BD_ADDR_LEN);
            *p_peer_addr_type = p_dev_rec->ble.static_addr_type;
            *p_own_addr_type = BLE_ADDR_RANDOM_ID;
        }
        else
        {
            /* resolving list is empty, not enabled */
            *p_own_addr_type = BLE_ADDR_RANDOM;
        }
    }
    /* privacy 1.1, or privacy 1.2, general discoverable/connectable mode, disable privacy in */
    /* controller fall back to host based privacy */
    else
        if(btm_cb.ble_ctr_cb.privacy_mode !=  BTM_PRIVACY_NONE)
        {
            *p_own_addr_type = BLE_ADDR_RANDOM;
        }

    #endif
    /* if no privacy,do not set any peer address,*/
    /* local address type go by global privacy setting */
    return evt_type;
}

/*******************************************************************************
**
** Function         BTM_BleSetAdvParams
**
** Description      This function is called to set advertising parameters.
**
** Parameters       adv_int_min: minimum advertising interval
**                  adv_int_max: maximum advertising interval
**                  p_dir_bda: connectable direct initiator's LE device address
**                  chnl_map: advertising channel map.
**
** Returns          void
**
*******************************************************************************/
tBTM_STATUS BTM_BleSetAdvParams(uint16_t adv_int_min, uint16_t adv_int_max,
                                tBLE_BD_ADDR *p_dir_bda,
                                tBTM_BLE_ADV_CHNL_MAP chnl_map)
{
    tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb;
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    tBTM_STATUS status = BTM_SUCCESS;
    BD_ADDR     p_addr_ptr =  {0};
    tBLE_ADDR_TYPE   init_addr_type = BLE_ADDR_PUBLIC;
    tBLE_ADDR_TYPE   own_addr_type = p_addr_cb->own_addr_type;
    uint8_t            adv_mode = p_cb->adv_mode;
    BTM_TRACE_EVENT("BTM_BleSetAdvParams");

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return BTM_ILLEGAL_VALUE;
    }

    if(!BTM_BLE_ISVALID_PARAM(adv_int_min, BTM_BLE_ADV_INT_MIN, BTM_BLE_ADV_INT_MAX) ||
            !BTM_BLE_ISVALID_PARAM(adv_int_max, BTM_BLE_ADV_INT_MIN, BTM_BLE_ADV_INT_MAX))
    {
        return BTM_ILLEGAL_VALUE;
    }

    p_cb->adv_interval_min = adv_int_min;
    p_cb->adv_interval_max = adv_int_max;
    p_cb->adv_chnl_map = chnl_map;

    if(p_dir_bda)
    {
        wm_memcpy(&p_cb->direct_bda, p_dir_bda, sizeof(tBLE_BD_ADDR));
    }

    BTM_TRACE_EVENT("update params for an active adv");
    btm_ble_stop_adv();
    p_cb->evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &init_addr_type,
                     &own_addr_type);
    /* update adv params */
    btsnd_hcic_ble_write_adv_params(p_cb->adv_interval_min,
                                    p_cb->adv_interval_max,
                                    p_cb->evt_type,
                                    own_addr_type,
                                    init_addr_type,
                                    p_addr_ptr,
                                    p_cb->adv_chnl_map,
                                    p_cb->afp);

    if(adv_mode == BTM_BLE_ADV_ENABLE)
    {
        btm_ble_start_adv();
    }

    return status;
}



/*******************************************************************************
**
** Function         BTM_BleSetAdvExtParams
**
** Description      This function is called to set extended advertising parameters.
**
** Parameters       adv_int_min: minimum advertising interval
**                  adv_int_max: maximum advertising interval
**                  p_dir_bda: connectable direct initiator's LE device address
**                  chnl_map: advertising channel map.
**
** Returns          void
**
*******************************************************************************/

tBTM_STATUS BTM_BleSetAdvExtParams(uint16_t adv_int_min, uint16_t adv_int_max,uint8_t adv_type, uint8_t own_addr_type,
										tBTM_BLE_ADV_CHNL_MAP chnl_map, uint8_t afp, uint8_t peer_addr_type, tBLE_BD_ADDR *p_dir_bda)
{
    tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb;
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    tBTM_STATUS status = BTM_SUCCESS;
	uint8_t            adv_mode = p_cb->adv_mode;

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return BTM_ILLEGAL_VALUE;
    }

    if(!BTM_BLE_ISVALID_PARAM(adv_int_min, BTM_BLE_ADV_INT_MIN, BTM_BLE_ADV_INT_MAX) ||
            !BTM_BLE_ISVALID_PARAM(adv_int_max, BTM_BLE_ADV_INT_MIN, BTM_BLE_ADV_INT_MAX))
    {
        return BTM_ILLEGAL_VALUE;
    }	
	p_cb->adv_interval_min = adv_int_min;
    p_cb->adv_interval_max = adv_int_max;
    p_cb->adv_chnl_map = chnl_map;
    p_cb->evt_type = adv_type;
    btm_ble_stop_adv();
    /* update adv params */
    btsnd_hcic_ble_write_adv_params(p_cb->adv_interval_min,
                                    p_cb->adv_interval_max,
                                    p_cb->evt_type,
                                    own_addr_type,
                                    peer_addr_type,
                                    p_dir_bda,
                                    p_cb->adv_chnl_map,
                                    afp);

    if(adv_mode == BTM_BLE_ADV_ENABLE)
    {
        btm_ble_start_adv();
    }

    return status;	
}

/*******************************************************************************
**
** Function         BTM_BleReadAdvParams
**
** Description      This function is called to set advertising parameters.
**
** Parameters       adv_int_min: minimum advertising interval
**                  adv_int_max: maximum advertising interval
**                  p_dir_bda: connectable direct initiator's LE device address
**                  chnl_map: advertising channel map.
**
** Returns          void
**
*******************************************************************************/
void BTM_BleReadAdvParams(uint16_t *adv_int_min, uint16_t *adv_int_max,
                          tBLE_BD_ADDR *p_dir_bda, tBTM_BLE_ADV_CHNL_MAP *p_chnl_map)
{
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    BTM_TRACE_EVENT("BTM_BleReadAdvParams ");

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return ;
    }

    *adv_int_min = p_cb->adv_interval_min;
    *adv_int_max = p_cb->adv_interval_max;
    *p_chnl_map = p_cb->adv_chnl_map;

    if(p_dir_bda != NULL)
    {
        wm_memcpy(p_dir_bda, &p_cb->direct_bda, sizeof(tBLE_BD_ADDR));
    }
}

/*******************************************************************************
**
** Function         BTM_BleSetScanParams
**
** Description      This function is called to set scan parameters.
**
** Parameters       client_if - Client IF
**                  scan_interval - Scan interval
**                  scan_window - Scan window
**                  scan_mode -    Scan mode
**                  scan_setup_status_cback - Scan param setup status callback
**
** Returns          void
**
*******************************************************************************/
void BTM_BleSetScanParams(tGATT_IF client_if, uint32_t scan_interval, uint32_t scan_window,
                          tBLE_SCAN_MODE scan_mode,
                          tBLE_SCAN_PARAM_SETUP_CBACK scan_setup_status_cback)
{
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    uint32_t max_scan_interval;
    uint32_t max_scan_window;
    BTM_TRACE_EVENT("%s", __func__);

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return ;
    }

    /* If not supporting extended scan support, use the older range for checking */
    if(btm_cb.cmn_ble_vsc_cb.extended_scan_support == 0)
    {
        max_scan_interval = BTM_BLE_SCAN_INT_MAX;
        max_scan_window = BTM_BLE_SCAN_WIN_MAX;
    }
    else
    {
        /* If supporting extended scan support, use the new extended range for checking */
        max_scan_interval = BTM_BLE_EXT_SCAN_INT_MAX;
        max_scan_window = BTM_BLE_EXT_SCAN_WIN_MAX;
    }

    if(BTM_BLE_ISVALID_PARAM(scan_interval, BTM_BLE_SCAN_INT_MIN, max_scan_interval) &&
            BTM_BLE_ISVALID_PARAM(scan_window, BTM_BLE_SCAN_WIN_MIN, max_scan_window) &&
            (scan_mode == BTM_BLE_SCAN_MODE_ACTI || scan_mode == BTM_BLE_SCAN_MODE_PASS))
    {
        p_cb->scan_type = scan_mode;
        p_cb->scan_interval = scan_interval;
        p_cb->scan_window = scan_window;

        if(scan_setup_status_cback != NULL)
        {
            scan_setup_status_cback(client_if, BTM_SUCCESS);
        }
    }
    else
    {
        if(scan_setup_status_cback != NULL)
        {
            scan_setup_status_cback(client_if, BTM_ILLEGAL_VALUE);
        }

        BTM_TRACE_ERROR("Illegal params: scan_interval = %d scan_window = %d",
                        scan_interval, scan_window);
    }
}

/*******************************************************************************
**
** Function         BTM_BleWriteScanRsp
**
** Description      This function is called to write LE scan response.
**
** Parameters:      p_scan_rsp: scan response information.
**
** Returns          void
**
*******************************************************************************/
tBTM_STATUS BTM_BleWriteScanRsp(tBTM_BLE_AD_MASK data_mask, tBTM_BLE_ADV_DATA *p_data)
{
    tBTM_STATUS     status = BTM_NO_RESOURCES;
    uint8_t   rsp_data[BTM_BLE_AD_DATA_LEN],
              *p = rsp_data;
    BTM_TRACE_EVENT("%s: data_mask:%08x", __func__, data_mask);

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return BTM_ILLEGAL_VALUE;
    }

    wm_memset(rsp_data, 0, BTM_BLE_AD_DATA_LEN);
    btm_ble_build_adv_data(&data_mask, &p, p_data);

    if(btsnd_hcic_ble_set_scan_rsp_data((uint8_t)(p - rsp_data), rsp_data))
    {
        status = BTM_SUCCESS;

        if(data_mask != 0)
        {
            btm_cb.ble_ctr_cb.inq_var.scan_rsp = TRUE;
        }
        else
        {
            btm_cb.ble_ctr_cb.inq_var.scan_rsp = TRUE;  //FORCE TO TRUE, NO SENSE  SETTING TO FALSE;
        }
    }
    else
    {
        status = BTM_ILLEGAL_VALUE;
    }

    return status;
}

/*******************************************************************************
**
** Function         BTM_BleWriteAdvData
**
** Description      This function is called to write advertising data.
**
** Parameters:       None.
**
** Returns          void
**
*******************************************************************************/
tBTM_STATUS BTM_BleWriteAdvData(tBTM_BLE_AD_MASK data_mask, tBTM_BLE_ADV_DATA *p_data)
{
    tBTM_BLE_LOCAL_ADV_DATA *p_cb_data = &btm_cb.ble_ctr_cb.inq_var.adv_data;
    uint8_t  *p;
    tBTM_BLE_AD_MASK   mask = data_mask;
    BTM_TRACE_EVENT("BTM_BleWriteAdvData ");

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return BTM_ILLEGAL_VALUE;
    }

    wm_memset(p_cb_data, 0, sizeof(tBTM_BLE_LOCAL_ADV_DATA));
    p = p_cb_data->ad_data;
    p_cb_data->data_mask = data_mask;
    p_cb_data->p_flags = btm_ble_build_adv_data(&mask, &p, p_data);
    p_cb_data->p_pad = p;

    if(mask != 0)
    {
        BTM_TRACE_ERROR("Partial data write into ADV");
    }

    if(data_mask&BTM_BLE_AD_BIT_PURE_DATA)
    {
        p_cb_data->pure_data = 1;     //per user specifc the advertisement payload, we donot append the BTM_BLE_AD_BIT_FLAGS
    }else
    {
        p_cb_data->pure_data = 0;
    }
    p_cb_data->data_mask &= ~mask;
    
    if(btsnd_hcic_ble_set_adv_data((uint8_t)(p_cb_data->p_pad - p_cb_data->ad_data),
                                   p_cb_data->ad_data))
    {
        return BTM_SUCCESS;
    }
    else
    {
        return BTM_NO_RESOURCES;
    }
}

/*******************************************************************************
**
** Function         BTM_CheckAdvData
**
** Description      This function is called to get ADV data for a specific type.
**
** Parameters       p_adv - pointer of ADV data
**                  type   - finding ADV data type
**                  p_length - return the length of ADV data not including type
**
** Returns          pointer of ADV data
**
*******************************************************************************/
uint8_t *BTM_CheckAdvData(uint8_t *p_adv, uint8_t type, uint8_t *p_length)
{
    uint8_t *p = p_adv;
    uint8_t length;
    uint8_t adv_type;
    BTM_TRACE_API("%s: type=0x%02x", __func__, type);
    STREAM_TO_UINT8(length, p);

    while(length && (p - p_adv <= BTM_BLE_CACHE_ADV_DATA_MAX))
    {
        STREAM_TO_UINT8(adv_type, p);

        if(adv_type == type)
        {
            /* length doesn't include itself */
            *p_length = length - 1; /* minus the length of type */
            return p;
        }

        p += length - 1; /* skip the length of data */
        STREAM_TO_UINT8(length, p);
    }

    *p_length = 0;
    return NULL;
}

/*******************************************************************************
**
** Function         BTM__BLEReadDiscoverability
**
** Description      This function is called to read the current LE discoverability
**                  mode of the device.
**
** Returns          BTM_BLE_NON_DISCOVERABLE ,BTM_BLE_LIMITED_DISCOVERABLE or
**                     BTM_BLE_GENRAL_DISCOVERABLE
**
*******************************************************************************/
uint16_t BTM_BleReadDiscoverability()
{
    BTM_TRACE_API("%s", __FUNCTION__);
    return (btm_cb.ble_ctr_cb.inq_var.discoverable_mode);
}

/*******************************************************************************
**
** Function         BTM__BLEReadConnectability
**
** Description      This function is called to read the current LE connectibility
**                  mode of the device.
**
** Returns          BTM_BLE_NON_CONNECTABLE or BTM_BLE_CONNECTABLE
**
*******************************************************************************/
uint16_t BTM_BleReadConnectability()
{
    BTM_TRACE_API("%s", __FUNCTION__);
    return (btm_cb.ble_ctr_cb.inq_var.connectable_mode);
}
/*******************************************************************************
**
** Function         btm_ble_map_adv_tx_power
**
** Description      return the actual power in dBm based on the mapping in config file
**
** Parameters       advertise parameters used for this instance.
**
** Returns          tx power in dBm
**
*******************************************************************************/
int btm_ble_tx_power[BTM_BLE_ADV_TX_POWER_MAX + 1] = BTM_BLE_ADV_TX_POWER;
char btm_ble_map_adv_tx_power(int tx_power_index)
{
    if(0 <= tx_power_index && tx_power_index < BTM_BLE_ADV_TX_POWER_MAX)
    {
        return (char)btm_ble_tx_power[tx_power_index];
    }

    return 0;
}

/*******************************************************************************
**
** Function         btm_ble_build_adv_data
**
** Description      This function is called build the adv data and rsp data.
*******************************************************************************/
uint8_t *btm_ble_build_adv_data(tBTM_BLE_AD_MASK *p_data_mask, uint8_t **p_dst,
                                tBTM_BLE_ADV_DATA *p_data)
{
    uint32_t data_mask = *p_data_mask;
    uint8_t   *p = *p_dst,
               *p_flag = NULL;
    uint16_t  len = BTM_BLE_AD_DATA_LEN, cp_len = 0;
    uint8_t   i = 0;
    tBTM_BLE_PROP_ELEM      *p_elem;
    BTM_TRACE_EVENT(" btm_ble_build_adv_data");

    /* build the adv data structure and build the data string */
    if(data_mask)
    {

	    /*pure data, note we used the manufacturer buffer and length by now*/
		if(len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_PURE_DATA&&
                p_data && p_data->manu.len != 0)
		{
			if(p_data->manu.len > len )
            {
                cp_len = len ;
            }
            else
            {
                cp_len = p_data->manu.len;
            }
			/*just copy the specific data*/
			ARRAY_TO_STREAM(p, p_data->manu.val, cp_len);
			//data_mask &= ~BTM_BLE_AD_BIT_PURE_DATA;
			data_mask = 0; //force to clear other mask if exists. this bit should be exclusive
		}
		
        /* flags */
        if(data_mask & BTM_BLE_AD_BIT_FLAGS)
        {
            *p++ = MIN_ADV_LENGTH;
            *p++ = BTM_BLE_AD_TYPE_FLAG;
            p_flag = p;

            if(p_data)
            {
                *p++ = p_data->flag;
            }
            else
            {
                *p++ = 0;
            }

            len -= 3;
            data_mask &= ~BTM_BLE_AD_BIT_FLAGS;
        }

        /* appearance data */
        if(len > 3 && data_mask & BTM_BLE_AD_BIT_APPEARANCE)
        {
            *p++ = 3; /* length */
            *p++ = BTM_BLE_AD_TYPE_APPEARANCE;
            UINT16_TO_STREAM(p, p_data->appearance);
            len -= 4;
            data_mask &= ~BTM_BLE_AD_BIT_APPEARANCE;
        }

        /* device name */
        #if BTM_MAX_LOC_BD_NAME_LEN > 0

        if(len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_DEV_NAME)
        {
            if(strlen(btm_cb.cfg.bd_name) > (uint16_t)(len - MIN_ADV_LENGTH))
            {
                *p++ = len - MIN_ADV_LENGTH + 1;
                *p++ = BTM_BLE_AD_TYPE_NAME_SHORT;
                ARRAY_TO_STREAM(p, btm_cb.cfg.bd_name, len - MIN_ADV_LENGTH);
            }
            else
            {
                cp_len = (uint16_t)strlen(btm_cb.cfg.bd_name);
                *p++ = cp_len + 1;
                *p++ = BTM_BLE_AD_TYPE_NAME_CMPL;
                ARRAY_TO_STREAM(p, btm_cb.cfg.bd_name, cp_len);
            }

            len -= (cp_len + MIN_ADV_LENGTH);
            data_mask &= ~BTM_BLE_AD_BIT_DEV_NAME;
        }

        #endif

		
        /* manufacturer data */
        if(len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_MANU &&
                p_data && p_data->manu.len != 0)
        {
            if(p_data->manu.len > (len - MIN_ADV_LENGTH))
            {
                cp_len = len - MIN_ADV_LENGTH;
            }
            else
            {
                cp_len = p_data->manu.len;
            }

            *p++ = cp_len + 1;
            *p++ = BTM_BLE_AD_TYPE_MANU;
            ARRAY_TO_STREAM(p, p_data->manu.val, cp_len);
            len -= (cp_len + MIN_ADV_LENGTH);
            data_mask &= ~BTM_BLE_AD_BIT_MANU;
        }

        /* TX power */
        if(len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_TX_PWR)
        {
            *p++ = MIN_ADV_LENGTH;
            *p++ = BTM_BLE_AD_TYPE_TX_PWR;

            if(p_data->tx_power > BTM_BLE_ADV_TX_POWER_MAX)
            {
                p_data->tx_power = BTM_BLE_ADV_TX_POWER_MAX;
            }

            *p++ = btm_ble_map_adv_tx_power(p_data->tx_power);
            len -= 3;
            data_mask &= ~BTM_BLE_AD_BIT_TX_PWR;
        }

        /* 16 bits services */
        if(len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_SERVICE &&
                p_data && p_data->services.num_service != 0)
        {
            if(p_data->services.num_service * LEN_UUID_16 > (len - MIN_ADV_LENGTH))
            {
                cp_len = (len - MIN_ADV_LENGTH) / LEN_UUID_16;
                *p ++ = 1 + cp_len * LEN_UUID_16;
                *p++ = BTM_BLE_AD_TYPE_16SRV_PART;
            }
            else
            {
                cp_len = p_data->services.num_service;
                *p++ = 1 + cp_len * LEN_UUID_16;
                *p++ = BTM_BLE_AD_TYPE_16SRV_CMPL;
            }

            for(i = 0; i < cp_len; i ++)
            {
                UINT16_TO_STREAM(p, *(p_data->services.uuid + i));
            }

            len -= (cp_len * MIN_ADV_LENGTH + MIN_ADV_LENGTH);
            data_mask &= ~BTM_BLE_AD_BIT_SERVICE;
        }

        /* 32 bits service uuid */
        if(len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_SERVICE_32 &&
                p_data && p_data->service_32b.num_service != 0)
        {
            if((p_data->service_32b.num_service * LEN_UUID_32) > (len - MIN_ADV_LENGTH))
            {
                cp_len = (len - MIN_ADV_LENGTH) / LEN_UUID_32;
                *p ++ = 1 + cp_len * LEN_UUID_32;
                *p++ = BTM_BLE_AD_TYPE_32SRV_PART;
            }
            else
            {
                cp_len = p_data->service_32b.num_service;
                *p++ = 1 + cp_len * LEN_UUID_32;
                *p++ = BTM_BLE_AD_TYPE_32SRV_CMPL;
            }

            for(i = 0; i < cp_len; i ++)
            {
                UINT32_TO_STREAM(p, *(p_data->service_32b.uuid + i));
            }

            len -= (cp_len * LEN_UUID_32 + MIN_ADV_LENGTH);
            data_mask &= ~BTM_BLE_AD_BIT_SERVICE_32;
        }

        /* 128 bits services */
        if(len >= (MAX_UUID_SIZE + 2) && data_mask & BTM_BLE_AD_BIT_SERVICE_128 &&
                p_data && p_data->services_128b.num_service)
        {
            *p ++ = 1 + MAX_UUID_SIZE;

            if(!p_data->services_128b.list_cmpl)
            {
                *p++ = BTM_BLE_AD_TYPE_128SRV_PART;
            }
            else
            {
                *p++ = BTM_BLE_AD_TYPE_128SRV_CMPL;
            }

            ARRAY_TO_STREAM(p, p_data->services_128b.uuid128, MAX_UUID_SIZE);
            len -= (MAX_UUID_SIZE + MIN_ADV_LENGTH);
            data_mask &= ~BTM_BLE_AD_BIT_SERVICE_128;
        }

        /* 32 bits Service Solicitation UUIDs */
        if(len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_SERVICE_32SOL &&
                p_data->sol_service_32b.num_service != 0)
        {
            if((p_data->sol_service_32b.num_service * LEN_UUID_32) > (len - MIN_ADV_LENGTH))
            {
                cp_len = (len - MIN_ADV_LENGTH) / LEN_UUID_32;
                *p ++ = 1 + cp_len * LEN_UUID_32;
            }
            else
            {
                cp_len = p_data->sol_service_32b.num_service;
                *p++ = 1 + cp_len * LEN_UUID_32;
            }

            *p++ = BTM_BLE_AD_TYPE_32SOL_SRV_UUID;

            for(i = 0; i < cp_len; i ++)
            {
                UINT32_TO_STREAM(p, *(p_data->sol_service_32b.uuid + i));
            }

            len -= (cp_len * LEN_UUID_32 + MIN_ADV_LENGTH);
            data_mask &= ~BTM_BLE_AD_BIT_SERVICE_32SOL;
        }

        /* 128 bits Solicitation services UUID */
        if(len >= (MAX_UUID_SIZE + MIN_ADV_LENGTH) && data_mask & BTM_BLE_AD_BIT_SERVICE_128SOL &&
                p_data && p_data->sol_service_128b.num_service)
        {
            *p ++ = 1 + MAX_UUID_SIZE;
            *p++ = BTM_BLE_AD_TYPE_128SOL_SRV_UUID;
            ARRAY_TO_STREAM(p, p_data->sol_service_128b.uuid128, MAX_UUID_SIZE);
            len -= (MAX_UUID_SIZE + MIN_ADV_LENGTH);
            data_mask &= ~BTM_BLE_AD_BIT_SERVICE_128SOL;
        }

        /* 16bits/32bits/128bits Service Data */
        if(len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_SERVICE_DATA &&
                p_data && p_data->service_data.len != 0)
        {
            if(len  > (p_data->service_data.service_uuid.len + MIN_ADV_LENGTH))
            {
                if(p_data->service_data.len > (len - MIN_ADV_LENGTH))
                {
                    cp_len = len - MIN_ADV_LENGTH - p_data->service_data.service_uuid.len;
                }
                else
                {
                    cp_len = p_data->service_data.len;
                }

                *p++ = cp_len + 1 + p_data->service_data.service_uuid.len;

                if(p_data->service_data.service_uuid.len == LEN_UUID_16)
                {
                    *p++ = BTM_BLE_AD_TYPE_SERVICE_DATA;
                    UINT16_TO_STREAM(p, p_data->service_data.service_uuid.uu.uuid16);
                }
                else
                    if(p_data->service_data.service_uuid.len == LEN_UUID_32)
                    {
                        *p++ = BTM_BLE_AD_TYPE_32SERVICE_DATA;
                        UINT32_TO_STREAM(p, p_data->service_data.service_uuid.uu.uuid32);
                    }
                    else
                    {
                        *p++ = BTM_BLE_AD_TYPE_128SERVICE_DATA;
                        ARRAY_TO_STREAM(p, p_data->service_data.service_uuid.uu.uuid128,
                                        LEN_UUID_128);
                    }

                ARRAY_TO_STREAM(p, p_data->service_data.val, cp_len);
                len -= (cp_len + MIN_ADV_LENGTH + p_data->service_data.service_uuid.len);
                data_mask &= ~BTM_BLE_AD_BIT_SERVICE_DATA;
            }
            else
            {
                BTM_TRACE_WARNING("service data does not fit");
            }
        }

        if(len >= 6 && data_mask & BTM_BLE_AD_BIT_INT_RANGE &&
                p_data)
        {
            *p++ = 5;
            *p++ = BTM_BLE_AD_TYPE_INT_RANGE;
            UINT16_TO_STREAM(p, p_data->int_range.low);
            UINT16_TO_STREAM(p, p_data->int_range.hi);
            len -= 6;
            data_mask &= ~BTM_BLE_AD_BIT_INT_RANGE;
        }

        if(data_mask & BTM_BLE_AD_BIT_PROPRIETARY && p_data)
        {
            for(i = 0; i < p_data->proprietary.num_elem; ++i)
            {
                p_elem = &p_data->proprietary.elem[i];

                if(len >= (MIN_ADV_LENGTH + p_elem->len))/* len byte(1) + ATTR type(1) + Uuid len(2)
                                                          + value length */
                {
                    *p ++ = p_elem->len + 1; /* Uuid len + value length */
                    *p ++ = p_elem->adv_type;
                    ARRAY_TO_STREAM(p, p_elem->val, p_elem->len);
                    len -= (MIN_ADV_LENGTH + p_elem->len);
                }
                else
                {
                    BTM_TRACE_WARNING("data exceed max adv packet length");
                    break;
                }
            }

            data_mask &= ~BTM_BLE_AD_BIT_PROPRIETARY;
        }
    }

    *p_data_mask = data_mask;
    *p_dst = p;
    return p_flag;
}
/*******************************************************************************
**
** Function         btm_ble_select_adv_interval
**
** Description      select adv interval based on device mode
**
** Returns          void
**
*******************************************************************************/
static uint8_t btm_ble_select_adv_interval(tBTM_BLE_INQ_CB *p_cb, uint8_t evt_type, uint16_t *p_adv_int_min, uint16_t *p_adv_int_max)
{
    uint8_t adv_interval_type = 0;  //default setting;
    
    if(p_cb->adv_interval_min && p_cb->adv_interval_max)
    {
        *p_adv_int_min = p_cb->adv_interval_min;
        *p_adv_int_max = p_cb->adv_interval_max;
        adv_interval_type = 1;     //user setting
    }
    else
    {
        switch(evt_type)
        {
            case BTM_BLE_CONNECT_EVT:
            case BTM_BLE_CONNECT_LO_DUTY_DIR_EVT:
                *p_adv_int_min = *p_adv_int_max = BTM_BLE_GAP_ADV_FAST_INT_1;
                break;

            case BTM_BLE_NON_CONNECT_EVT:
            case BTM_BLE_DISCOVER_EVT:
                *p_adv_int_min = *p_adv_int_max = BTM_BLE_GAP_ADV_FAST_INT_2;
                break;

            /* connectable directed event */
            case BTM_BLE_CONNECT_DIR_EVT:
                *p_adv_int_min = BTM_BLE_GAP_ADV_DIR_MIN_INT;
                *p_adv_int_max = BTM_BLE_GAP_ADV_DIR_MAX_INT;
                break;

            default:
                *p_adv_int_min = *p_adv_int_max = BTM_BLE_GAP_ADV_SLOW_INT;
                break;
        }
    }

    return adv_interval_type;
}

/*******************************************************************************
**
** Function         btm_ble_update_dmt_flag_bits
**
** Description      Obtain updated adv flag value based on connect and discoverability mode.
**                  Also, setup DMT support value in the flag based on whether the controller
**                  supports both LE and BR/EDR.
**
** Parameters:      flag_value (Input / Output) - flag value
**                  connect_mode (Input) - Connect mode value
**                  disc_mode (Input) - discoverability mode
**
** Returns          void
**
*******************************************************************************/
void btm_ble_update_dmt_flag_bits(uint8_t *adv_flag_value, const uint16_t connect_mode,
                                  const uint16_t disc_mode)
{
    /* BR/EDR non-discoverable , non-connectable */
    if((disc_mode & BTM_DISCOVERABLE_MASK) == 0 &&
            (connect_mode & BTM_CONNECTABLE_MASK) == 0)
    {
        *adv_flag_value |= BTM_BLE_BREDR_NOT_SPT;
    }
    else
    {
        *adv_flag_value &= ~BTM_BLE_BREDR_NOT_SPT;
    }

    /* if local controller support, mark both controller and host support in flag */
    //if (controller_get_interface()->supports_simultaneous_le_bredr())
    if(HCI_SIMUL_LE_BREDR_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
    {
        *adv_flag_value |= (BTM_BLE_DMT_CONTROLLER_SPT | BTM_BLE_DMT_HOST_SPT);
    }
    else
    {
        *adv_flag_value &= ~(BTM_BLE_DMT_CONTROLLER_SPT | BTM_BLE_DMT_HOST_SPT);
    }
}

/*******************************************************************************
**
** Function         btm_ble_set_adv_flag
**
** Description      Set adv flag in adv data.
**
** Parameters:      connect_mode (Input)- Connect mode value
**                  disc_mode (Input) - discoverability mode
**
** Returns          void
**
*******************************************************************************/
void btm_ble_set_adv_flag(uint16_t connect_mode, uint16_t disc_mode)
{
    uint8_t flag = 0, old_flag = 0;
    tBTM_BLE_LOCAL_ADV_DATA *p_adv_data = &btm_cb.ble_ctr_cb.inq_var.adv_data;

    if(p_adv_data->p_flags != NULL)
    {
        flag = old_flag = *(p_adv_data->p_flags);
    }

    btm_ble_update_dmt_flag_bits(&flag, connect_mode, disc_mode);
    LOG_DEBUG(LOG_TAG, "disc_mode %04x", disc_mode);

    /* update discoverable flag */
    if(disc_mode & BTM_BLE_LIMITED_DISCOVERABLE)
    {
        flag &= ~BTM_BLE_GEN_DISC_FLAG;
        flag |= BTM_BLE_LIMIT_DISC_FLAG;
    }
    else
        if(disc_mode & BTM_BLE_GENERAL_DISCOVERABLE)
        {
            flag |= BTM_BLE_GEN_DISC_FLAG;
            flag &= ~BTM_BLE_LIMIT_DISC_FLAG;
        }
        else /* remove all discoverable flags */
        {
            flag &= ~(BTM_BLE_LIMIT_DISC_FLAG | BTM_BLE_GEN_DISC_FLAG);
        }
    if(flag != old_flag)
    {
        btm_ble_update_adv_flag(flag);
    }
}
/*******************************************************************************
**
** Function         btm_ble_set_discoverability
**
** Description      This function is called to set BLE discoverable mode.
**
** Parameters:      combined_mode: discoverability mode.
**
** Returns          BTM_SUCCESS is status set successfully; otherwise failure.
**
*******************************************************************************/
tBTM_STATUS btm_ble_set_discoverability(uint16_t combined_mode)
{
    tBTM_LE_RANDOM_CB   *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb;
    tBTM_BLE_INQ_CB     *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    uint16_t              mode = (combined_mode &  BTM_BLE_DISCOVERABLE_MASK);
    uint8_t               new_mode = BTM_BLE_ADV_ENABLE;
    uint8_t               evt_type;
    tBTM_STATUS         status = BTM_SUCCESS;
    BD_ADDR             p_addr_ptr = {0};
    tBLE_ADDR_TYPE      init_addr_type = BLE_ADDR_PUBLIC,
                        own_addr_type = p_addr_cb->own_addr_type;
    uint16_t              adv_int_min, adv_int_max;
    uint8_t                 adv_interval_type = 0;
    BTM_TRACE_EVENT("%s mode=0x%0x combined_mode=0x%x p_cb->connectable_mode=0x%x\r\n", __FUNCTION__, mode, combined_mode, p_cb->connectable_mode);

    /*** Check mode parameter ***/
    if(mode > BTM_BLE_MAX_DISCOVERABLE)
    {
        return(BTM_ILLEGAL_VALUE);
    }

    p_cb->discoverable_mode = mode;
    evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &init_addr_type, &own_addr_type);

    if(p_cb->connectable_mode == BTM_BLE_NON_CONNECTABLE && mode == BTM_BLE_NON_DISCOVERABLE)
    {
        new_mode = BTM_BLE_ADV_DISABLE;
    }

    adv_interval_type = btm_ble_select_adv_interval(p_cb, evt_type, &adv_int_min, &adv_int_max);
    #ifdef USE_ALARM
    alarm_cancel(p_cb->fast_adv_timer);
    #else
    btu_stop_timer(&p_cb->fast_adv_timer);
    #endif
    /* update adv params if start advertising */
    BTM_TRACE_EVENT("btm_ble_set_discoverability, new_mode= %d, evt_type=0x%x p-cb->evt_type=0x%x \r\n", new_mode, evt_type, p_cb->evt_type);

    if(new_mode == BTM_BLE_ADV_ENABLE)
    {
        btm_ble_set_adv_flag(btm_cb.btm_inq_vars.connectable_mode, combined_mode);

        if(evt_type != p_cb->evt_type || p_cb->adv_addr_type != own_addr_type
                || !p_cb->fast_adv_on)
        {
            status = btm_ble_stop_adv();

            if(status != BTM_SUCCESS)
            {
                BTM_TRACE_EVENT("btm_ble_stop_adv ret=%d\r\n", status);
            }

            /* update adv params */
            if(!btsnd_hcic_ble_write_adv_params(adv_int_min,
                                                adv_int_max,
                                                evt_type,
                                                own_addr_type,
                                                init_addr_type,
                                                p_addr_ptr,
                                                p_cb->adv_chnl_map,
                                                p_cb->afp))
            {
                status = BTM_NO_RESOURCES;
            }
            else
            {
                p_cb->evt_type = evt_type;
                p_cb->adv_addr_type = own_addr_type;
            }
        }
    }

    BTM_TRACE_EVENT("dis Update adv mode, status=%d, new_mode=%d, p_cb->adv_mode=%d\r\n", status, new_mode, p_cb->adv_mode);

    if(status == BTM_SUCCESS && p_cb->adv_mode != new_mode)
    {
        if(new_mode == BTM_BLE_ADV_ENABLE)
        {
            status = btm_ble_start_adv();
        }
        else
        {
            status = btm_ble_stop_adv();
        }

        if(status != BTM_SUCCESS)
        {
            BTM_TRACE_EVENT("btm_ble_stop/start_adv ret=%d\r\n", status);
        }
    }

    if(p_cb->adv_mode == BTM_BLE_ADV_ENABLE)
    {
        if(adv_interval_type == 0)
        {
            p_cb->fast_adv_on = TRUE;
            /* start initial GAP mode adv timer */
            #ifdef USE_ALARM
            alarm_set_on_queue(p_cb->fast_adv_timer,
                               BTM_BLE_GAP_FAST_ADV_TIMEOUT_MS,
                               btm_ble_fast_adv_timer_timeout, NULL,
                               btu_general_alarm_queue);
            #else
            p_cb->fast_adv_timer.p_cback = (TIMER_CBACK *)&btm_ble_fast_adv_timer_timeout;
            p_cb->fast_adv_timer.param = (TIMER_PARAM_TYPE)NULL;
            btu_start_timer(&p_cb->fast_adv_timer, BTU_TTYPE_BLE_GAP_FAST_ADV, BTM_BLE_GAP_FAST_ADV_TIMEOUT_MS / 1000);
            #endif
        }
    }
    else
    {
        #if BLE_PRIVACY_SPT == TRUE
        btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE);
        #endif
    }

    /* set up stop advertising timer */
    if(status == BTM_SUCCESS && mode == BTM_BLE_LIMITED_DISCOVERABLE)
    {
        BTM_TRACE_EVENT("start timer for limited disc mode duration=%d ms",
                        BTM_BLE_GAP_LIM_TIMEOUT_MS);
        /* start Tgap(lim_timeout) */
        #ifdef USE_ALARM
        alarm_set_on_queue(p_cb->inquiry_timer, BTM_BLE_GAP_LIM_TIMEOUT_MS,
                           btm_ble_inquiry_timer_gap_limited_discovery_timeout,
                           NULL, btu_general_alarm_queue);
        #else
        p_cb->inquiry_timer.p_cback = (TIMER_CBACK *)&btm_ble_inquiry_timer_gap_limited_discovery_timeout;
        p_cb->inquiry_timer.param = (TIMER_PARAM_TYPE)NULL;
        btu_start_timer(&p_cb->inquiry_timer, BTU_TTYPE_BLE_GAP_LIM_DISC, BTM_BLE_GAP_LIM_TIMEOUT_MS / 1000);
        #endif
    }

    return status;
}

/*******************************************************************************
**
** Function         btm_ble_set_connectability
**
** Description      This function is called to set BLE connectability mode.
**
** Parameters:      combined_mode: connectability mode.
**
** Returns          BTM_SUCCESS is status set successfully; otherwise failure.
**
*******************************************************************************/
tBTM_STATUS btm_ble_set_connectability(uint16_t combined_mode)
{
    tBTM_LE_RANDOM_CB       *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb;
    tBTM_BLE_INQ_CB         *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    uint16_t                  mode = (combined_mode & BTM_BLE_CONNECTABLE_MASK);
    uint8_t                   new_mode = BTM_BLE_ADV_ENABLE;
    uint8_t                   evt_type;
    tBTM_STATUS             status = BTM_SUCCESS;
    BD_ADDR                 p_addr_ptr =  {0};
    tBLE_ADDR_TYPE          peer_addr_type = BLE_ADDR_PUBLIC,
                            own_addr_type = p_addr_cb->own_addr_type;
    uint16_t                  adv_int_min, adv_int_max;
    uint8_t                 adv_interval_type = 0;

    /*** Check mode parameter ***/
    if(mode > BTM_BLE_MAX_CONNECTABLE)
    {
        return(BTM_ILLEGAL_VALUE);
    }

    p_cb->connectable_mode = mode;
    evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &peer_addr_type, &own_addr_type);
    BTM_TRACE_EVENT("%s mode=0x%0x combined_mode=0x%x, p_cb->discoverable_mode=0x%x, evt_type=%d\r\n", __FUNCTION__, mode, combined_mode, p_cb->discoverable_mode,evt_type);

    if(mode == BTM_BLE_NON_CONNECTABLE && p_cb->discoverable_mode == BTM_BLE_NON_DISCOVERABLE)
    {
        new_mode = BTM_BLE_ADV_DISABLE;
    }

    adv_interval_type = btm_ble_select_adv_interval(p_cb, evt_type, &adv_int_min, &adv_int_max);
    #ifdef USE_ALARM
    alarm_cancel(p_cb->fast_adv_timer);
    #else
    btu_stop_timer(&p_cb->fast_adv_timer);
    #endif
    BTM_TRACE_EVENT("btm_ble_set_connectability, new_mode=%d\r\n", new_mode);

    /* update adv params if needed */
    if(new_mode == BTM_BLE_ADV_ENABLE)
    {
        btm_ble_set_adv_flag(combined_mode, btm_cb.btm_inq_vars.discoverable_mode);

        if(p_cb->evt_type != evt_type || p_cb->adv_addr_type != p_addr_cb->own_addr_type
                || !p_cb->fast_adv_on)
        {
            btm_ble_stop_adv();

            if(!btsnd_hcic_ble_write_adv_params(adv_int_min,
                                                adv_int_max,
                                                evt_type,
                                                own_addr_type,
                                                peer_addr_type,
                                                p_addr_ptr,
                                                p_cb->adv_chnl_map,
                                                p_cb->afp))
            {
                status = BTM_NO_RESOURCES;
            }
            else
            {
                p_cb->evt_type = evt_type;
                p_cb->adv_addr_type = own_addr_type;
            }
        }
    }

    /* update advertising mode */
    BTM_TRACE_EVENT("con Update adv mode, status=%d, new_mode=%d, p_cb->adv_mode=%d\r\n", status, new_mode, p_cb->adv_mode);

    if(status == BTM_SUCCESS && new_mode != p_cb->adv_mode)
    {
        if(new_mode == BTM_BLE_ADV_ENABLE)
        {
            status = btm_ble_start_adv();
        }
        else
        {
            status = btm_ble_stop_adv();
        }
    }

    if(p_cb->adv_mode == BTM_BLE_ADV_ENABLE)
    {
        if(adv_interval_type == 0)
        {
            p_cb->fast_adv_on = TRUE;
            /* start initial GAP mode adv timer */
            #ifdef USE_ALARM
            alarm_set_on_queue(p_cb->fast_adv_timer,
                               BTM_BLE_GAP_FAST_ADV_TIMEOUT_MS,
                               btm_ble_fast_adv_timer_timeout, NULL,
                               btu_general_alarm_queue);
            #else
            p_cb->fast_adv_timer.p_cback = (TIMER_CBACK *)&btm_ble_fast_adv_timer_timeout;
            p_cb->fast_adv_timer.param = (TIMER_PARAM_TYPE)NULL;
            btu_start_timer(&p_cb->fast_adv_timer, BTU_TTYPE_BLE_GAP_FAST_ADV,
                            BTM_BLE_GAP_FAST_ADV_TIMEOUT_MS / 1000);
            #endif
        }
    }
    else
    {
        #if BLE_PRIVACY_SPT == TRUE
        btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE);
        #endif
    }

    return status;
}

/*******************************************************************************
**
** Function         btm_ble_start_inquiry
**
** Description      This function is called to start BLE inquiry procedure.
**                  If the duration is zero, the periodic inquiry mode is cancelled.
**
** Parameters:      mode - GENERAL or LIMITED inquiry
**                  p_inq_params - pointer to the BLE inquiry parameter.
**                  p_results_cb - callback returning pointer to results (tBTM_INQ_RESULTS)
**                  p_cmpl_cb - callback indicating the end of an inquiry
**
**
**
** Returns          BTM_CMD_STARTED if successfully started
**                  BTM_NO_RESOURCES if could not allocate a message buffer
**                  BTM_BUSY - if an inquiry is already active
**
*******************************************************************************/
tBTM_STATUS btm_ble_start_inquiry(uint8_t mode, uint8_t   duration)
{
    tBTM_STATUS status = BTM_CMD_STARTED;
    tBTM_BLE_CB *p_ble_cb = &btm_cb.ble_ctr_cb;
    tBTM_INQUIRY_VAR_ST      *p_inq = &btm_cb.btm_inq_vars;
    BTM_TRACE_DEBUG("btm_ble_start_inquiry: mode = %02x inq_active = 0x%02x", mode, btm_cb.btm_inq_vars.inq_active);

    /* if selective connection is active, or inquiry is already active, reject it */
    if(BTM_BLE_IS_INQ_ACTIVE(p_ble_cb->scan_activity) ||
            BTM_BLE_IS_SEL_CONN_ACTIVE(p_ble_cb->scan_activity))
    {
        BTM_TRACE_ERROR("LE Inquiry is active, can not start inquiry");
        return(BTM_BUSY);
    }

    if(!BTM_BLE_IS_SCAN_ACTIVE(p_ble_cb->scan_activity))
    {
        btsnd_hcic_ble_set_scan_params(BTM_BLE_SCAN_MODE_ACTI,
                                       BTM_BLE_LOW_LATENCY_SCAN_INT,
                                       BTM_BLE_LOW_LATENCY_SCAN_WIN,
                                       btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type,
                                       SP_ADV_ALL);
        #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE)
        /* enable IRK list */
        btm_ble_enable_resolving_list_for_platform(BTM_BLE_RL_SCAN);
        #endif
        p_ble_cb->inq_var.scan_duplicate_filter  = BTM_BLE_DUPLICATE_DISABLE;
        status = btm_ble_start_scan();
    }
    else
        if((p_ble_cb->inq_var.scan_interval != BTM_BLE_LOW_LATENCY_SCAN_INT) ||
                (p_ble_cb->inq_var.scan_window != BTM_BLE_LOW_LATENCY_SCAN_WIN))
        {
            BTM_TRACE_DEBUG("%s, restart LE scan with low latency scan params", __FUNCTION__);
            btsnd_hcic_ble_set_scan_enable(BTM_BLE_SCAN_DISABLE, BTM_BLE_DUPLICATE_ENABLE);
            btsnd_hcic_ble_set_scan_params(BTM_BLE_SCAN_MODE_ACTI,
                                           BTM_BLE_LOW_LATENCY_SCAN_INT,
                                           BTM_BLE_LOW_LATENCY_SCAN_WIN,
                                           btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type,
                                           SP_ADV_ALL);
            btsnd_hcic_ble_set_scan_enable(BTM_BLE_SCAN_ENABLE, BTM_BLE_DUPLICATE_DISABLE);
        }

    if(status == BTM_CMD_STARTED)
    {
        p_inq->inq_active |= mode;
        p_ble_cb->scan_activity |= mode;
        BTM_TRACE_DEBUG("btm_ble_start_inquiry inq_active = 0x%02x", p_inq->inq_active);

        if(duration != 0)
        {
            /* start inquiry timer */
            
            #ifdef USE_ALARM
			uint64_t duration_ms = duration * 1000;
            alarm_set_on_queue(p_ble_cb->inq_var.inquiry_timer,
                               duration_ms, btm_ble_inquiry_timer_timeout,
                               NULL, btu_general_alarm_queue);
            #else
            p_ble_cb->inq_var.inquiry_timer.p_cback  = (TIMER_CBACK *)&btm_ble_inquiry_timer_timeout;
            p_ble_cb->inq_var.inquiry_timer.param = (TIMER_PARAM_TYPE)NULL;
            btu_start_timer(&p_ble_cb->inq_var.inquiry_timer, BTU_TTYPE_BLE_INQUIRY, duration);
            #endif
        }
    }

    return status;
}

/*******************************************************************************
**
** Function         btm_ble_read_remote_name_cmpl
**
** Description      This function is called when BLE remote name is received.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_read_remote_name_cmpl(uint8_t status, BD_ADDR bda, uint16_t length, char *p_name)
{
    uint8_t   hci_status = HCI_SUCCESS;
    BD_NAME bd_name;
    wm_memset(bd_name, 0, (BD_NAME_LEN + 1));

    if(length > BD_NAME_LEN)
    {
        length = BD_NAME_LEN;
    }

    wm_memcpy((uint8_t *)bd_name, p_name, length);

    if((!status) || (length == 0))
    {
        hci_status = HCI_ERR_HOST_TIMEOUT;
    }

    btm_process_remote_name(bda, bd_name, length + 1, hci_status);
    btm_sec_rmt_name_request_complete(bda, (uint8_t *)p_name, hci_status);
}

/*******************************************************************************
**
** Function         btm_ble_read_remote_name
**
** Description      This function read remote LE device name using GATT read
**                  procedure.
**
** Parameters:       None.
**
** Returns          void
**
*******************************************************************************/
tBTM_STATUS btm_ble_read_remote_name(BD_ADDR remote_bda, tBTM_INQ_INFO *p_cur, tBTM_CMPL_CB *p_cb)
{
    tBTM_INQUIRY_VAR_ST      *p_inq = &btm_cb.btm_inq_vars;

    if(!HCI_LE_HOST_SUPPORTED(btm_cb.devcb.local_lmp_features[HCI_EXT_FEATURES_PAGE_1]))
    {
        return BTM_ERR_PROCESSING;
    }

    if(p_cur &&
            p_cur->results.ble_evt_type != BTM_BLE_EVT_CONN_ADV &&
            p_cur->results.ble_evt_type != BTM_BLE_EVT_CONN_DIR_ADV)
    {
        BTM_TRACE_DEBUG("name request to non-connectable device failed.");
        return BTM_ERR_PROCESSING;
    }

    /* read remote device name using GATT procedure */
    if(p_inq->remname_active)
    {
        return BTM_BUSY;
    }

    if(!GAP_BleReadPeerDevName(remote_bda, btm_ble_read_remote_name_cmpl))
    {
        return BTM_BUSY;
    }

    p_inq->p_remname_cmpl_cb = p_cb;
    p_inq->remname_active = TRUE;
    wm_memcpy(p_inq->remname_bda, remote_bda, BD_ADDR_LEN);
    #ifdef USE_ALARM
    alarm_set_on_queue(p_inq->remote_name_timer,
                       BTM_EXT_BLE_RMT_NAME_TIMEOUT_MS,
                       btm_inq_remote_name_timer_timeout, NULL,
                       btu_general_alarm_queue);
    #else
    p_inq->remote_name_timer.p_cback = (TIMER_CBACK *)&btm_inq_remote_name_timer_timeout;
    p_inq->remote_name_timer.param = (TIMER_PARAM_TYPE)NULL;
    btu_start_timer(&p_inq->remote_name_timer,
                    BTU_TTYPE_BTM_RMT_NAME,
                    BTM_EXT_BLE_RMT_NAME_TIMEOUT_MS / 1000);
    #endif
    return BTM_CMD_STARTED;
}

/*******************************************************************************
**
** Function         btm_ble_cancel_remote_name
**
** Description      This function cancel read remote LE device name.
**
** Parameters:       None.
**
** Returns          void
**
*******************************************************************************/
uint8_t btm_ble_cancel_remote_name(BD_ADDR remote_bda)
{
    tBTM_INQUIRY_VAR_ST      *p_inq = &btm_cb.btm_inq_vars;
    uint8_t     status;
    status = GAP_BleCancelReadPeerDevName(remote_bda);
    p_inq->remname_active = FALSE;
    wm_memset(p_inq->remname_bda, 0, BD_ADDR_LEN);
    #ifdef USE_ALARM
    alarm_cancel(p_inq->remote_name_timer);
    #else
    btu_stop_timer(&p_inq->remote_name_timer);
    #endif
    return status;
}

/*******************************************************************************
**
** Function         btm_ble_update_adv_flag
**
** Description      This function update the limited discoverable flag in the adv
**                  data.
**
** Parameters:       None.
**
** Returns          void
**
*******************************************************************************/
static void btm_ble_update_adv_flag(uint8_t flag)
{
    tBTM_BLE_LOCAL_ADV_DATA *p_adv_data = &btm_cb.ble_ctr_cb.inq_var.adv_data;
    uint8_t   *p;

    if(p_adv_data->p_flags != NULL || p_adv_data->pure_data)
    {
        BTM_TRACE_DEBUG("btm_ble_update_adv_flag old=0x%x",   *p_adv_data->p_flags);
        *p_adv_data->p_flags = flag;
    }
    else /* no FLAGS in ADV data*/
    {
        p = (p_adv_data->p_pad == NULL) ? p_adv_data->ad_data : p_adv_data->p_pad;

        /* need 3 bytes space to stuff in the flags, if not */
        /* erase all written data, just for flags */
        if((BTM_BLE_AD_DATA_LEN - (p - p_adv_data->ad_data)) < 3)
        {
            p = p_adv_data->p_pad = p_adv_data->ad_data;
            wm_memset(p_adv_data->ad_data, 0, BTM_BLE_AD_DATA_LEN);
        }

        *p++ = 2;
        *p++ = BTM_BLE_AD_TYPE_FLAG;
        p_adv_data->p_flags = p;
        *p++ = flag;
        p_adv_data->p_pad = p;
    }

    if(btsnd_hcic_ble_set_adv_data((uint8_t)(p_adv_data->p_pad - p_adv_data->ad_data),
                                   p_adv_data->ad_data))
    {
        p_adv_data->data_mask |= BTM_BLE_AD_BIT_FLAGS;
    }
}

#if 0
/*******************************************************************************
**
** Function         btm_ble_parse_adv_data
**
** Description      This function parse the adv data into a structure.
**
** Returns          pointer to entry, or NULL if not found
**
*******************************************************************************/
static void btm_ble_parse_adv_data(tBTM_INQ_INFO *p_info, uint8_t *p_data,
                                   uint8_t len, tBTM_BLE_INQ_DATA *p_adv_data, uint8_t *p_buf)
{
    uint8_t   *p_cur = p_data;
    uint8_t   ad_len, ad_type, ad_flag;
    BTM_TRACE_EVENT(" btm_ble_parse_adv_data");

    while(len > 0)
    {
        BTM_TRACE_DEBUG("btm_ble_parse_adv_data: len = %d", len);

        if((ad_len = *p_cur ++) == 0)
        {
            break;
        }

        ad_type = *p_cur ++;
        BTM_TRACE_DEBUG("     ad_type = %02x ad_len = %d", ad_type, ad_len);

        switch(ad_type)
        {
            case BTM_BLE_AD_TYPE_NAME_SHORT:
            case BTM_BLE_AD_TYPE_NAME_CMPL:
                p_adv_data->ad_mask |= BTM_BLE_AD_BIT_DEV_NAME;

                if(p_info)
                {
                    p_info->remote_name_type = (ad_type == BTM_BLE_AD_TYPE_NAME_SHORT) ?
                                               BTM_BLE_NAME_SHORT : BTM_BLE_NAME_CMPL;
                    wm_memcpy(p_info->remote_name, p_cur, ad_len - 1);
                    p_info->remote_name[ad_len] = 0;
                    p_adv_data->p_remote_name = p_info->remote_name;
                    p_info->remote_name_len = p_adv_data->remote_name_len = ad_len - 1;
                    BTM_TRACE_DEBUG("BTM_BLE_AD_TYPE_NAME name = %s", p_adv_data->p_remote_name);
                }

                p_cur += (ad_len - 1);
                break;

            case BTM_BLE_AD_TYPE_FLAG:
                p_adv_data->ad_mask |= BTM_BLE_AD_BIT_FLAGS;
                ad_flag = *p_cur ++;
                p_adv_data->flag = (uint8_t)(ad_flag & BTM_BLE_ADV_FLAG_MASK) ;
                BTM_TRACE_DEBUG("BTM_BLE_AD_TYPE_FLAG flag = %s | %s | %s",
                                (p_adv_data->flag & BTM_BLE_LIMIT_DISC_FLAG) ? "LE_LIMIT_DISC" : "",
                                (p_adv_data->flag & BTM_BLE_GEN_DISC_FLAG) ? "LE_GENERAL_DISC" : "",
                                (p_adv_data->flag & BTM_BLE_BREDR_NOT_SPT) ? "LE Only device" : "");
                break;

            case BTM_BLE_AD_TYPE_TX_PWR:
                p_adv_data->ad_mask |= BTM_BLE_AD_BIT_TX_PWR;
                p_adv_data->tx_power_level = (int8_t) * p_cur ++;
                BTM_TRACE_DEBUG("BTM_BLE_AD_TYPE_TX_PWR tx_level = %d", p_adv_data->tx_power_level);
                break;

            case BTM_BLE_AD_TYPE_MANU:
            case BTM_BLE_AD_TYPE_16SRV_PART:
            case BTM_BLE_AD_TYPE_16SRV_CMPL:
                p_adv_data->ad_mask |= BTM_BLE_AD_BIT_SERVICE;
                /* need allocate memory to store UUID list */
                p_adv_data->service.num_service = (ad_len - 1) / 2;
                BTM_TRACE_DEBUG("service UUID list, num = %d", p_adv_data->service.num_service);
                p_cur += (ad_len - 1);
                break;

            case BTM_BLE_AD_TYPE_SOL_SRV_UUID:
                p_adv_data->ad_mask |= BTM_BLE_AD_BIT_SERVICE_SOL;
                /* need allocate memory to store UUID list */
                p_adv_data->service.num_service = (ad_len - 1) / 2;
                BTM_TRACE_DEBUG("service UUID list, num = %d", p_adv_data->service.num_service);
                p_cur += (ad_len - 1);
                break;

            case BTM_BLE_AD_TYPE_128SOL_SRV_UUID:
                p_adv_data->ad_mask |= BTM_BLE_AD_BIT_SERVICE_128SOL;
                /* need allocate memory to store UUID list */
                p_adv_data->service.num_service = (ad_len - 1) / 16;
                BTM_TRACE_DEBUG("service UUID list, num = %d", p_adv_data->service.num_service);
                p_cur += (ad_len - 1);
                break;

            case BTM_BLE_AD_TYPE_APPEARANCE:
            case BTM_BLE_AD_TYPE_PUBLIC_TARGET:
            case BTM_BLE_AD_TYPE_RANDOM_TARGET:
            default:
                break;
        }

        len -= (ad_len + 1);
    }
}
#endif

/*******************************************************************************
**
** Function         btm_ble_cache_adv_data
**
** Description      Update advertising cache data.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_cache_adv_data(tBTM_INQ_RESULTS *p_cur, uint8_t data_len, uint8_t *p, uint8_t evt_type)
{
    tBTM_BLE_INQ_CB     *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var;
    uint8_t *p_cache;
    uint8_t length;
    UNUSED(p_cur);

    /* cache adv report/scan response data */
    if(evt_type != BTM_BLE_SCAN_RSP_EVT)
    {
        p_le_inq_cb->adv_len = 0;
        wm_memset(p_le_inq_cb->adv_data_cache, 0, BTM_BLE_CACHE_ADV_DATA_MAX);
    }

    if(data_len > 0)
    {
        p_cache = &p_le_inq_cb->adv_data_cache[p_le_inq_cb->adv_len];
        STREAM_TO_UINT8(length, p);

        while(length && ((p_le_inq_cb->adv_len + length + 1) <= BTM_BLE_CACHE_ADV_DATA_MAX))
        {
            /* copy from the length byte & data into cache */
            wm_memcpy(p_cache, p - 1, length + 1);
            /* advance the cache pointer past data */
            p_cache += length + 1;
            /* increment cache length */
            p_le_inq_cb->adv_len += length + 1;
            /* skip the length of data */
            p += length;
            STREAM_TO_UINT8(length, p);
        }
    }

    /* parse service UUID from adv packet and save it in inq db eir_uuid */
    /* TODO */
}

/*******************************************************************************
**
** Function         btm_ble_is_discoverable
**
** Description      check ADV flag to make sure device is discoverable and match
**                  the search condition
**
** Parameters
**
** Returns          void
**
*******************************************************************************/
uint8_t btm_ble_is_discoverable(BD_ADDR bda, uint8_t evt_type, uint8_t *p)
{
    uint8_t               *p_flag, flag = 0, rt = 0;
    uint8_t                data_len;
    tBTM_INQ_PARMS      *p_cond = &btm_cb.btm_inq_vars.inqparms;
    tBTM_BLE_INQ_CB     *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var;
    UNUSED(p);

    /* for observer, always "discoverable */
    if(BTM_BLE_IS_OBS_ACTIVE(btm_cb.ble_ctr_cb.scan_activity))
    {
        rt |= BTM_BLE_OBS_RESULT;
    }

    if(BTM_BLE_IS_SEL_CONN_ACTIVE(btm_cb.ble_ctr_cb.scan_activity) &&
            (evt_type == BTM_BLE_CONNECT_EVT || evt_type == BTM_BLE_CONNECT_DIR_EVT))
    {
        rt |= BTM_BLE_SEL_CONN_RESULT;
    }

    /* does not match filter condition */
    if(p_cond->filter_cond_type == BTM_FILTER_COND_BD_ADDR &&
            memcmp(bda, p_cond->filter_cond.bdaddr_cond, BD_ADDR_LEN) != 0)
    {
        BTM_TRACE_DEBUG("BD ADDR does not meet filter condition");
        return rt;
    }

    if(p_le_inq_cb->adv_len != 0)
    {
        if((p_flag = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache,
                                      BTM_BLE_AD_TYPE_FLAG, &data_len)) != NULL)
        {
            flag = * p_flag;

            if((btm_cb.btm_inq_vars.inq_active & BTM_BLE_GENERAL_INQUIRY) &&
                    (flag & (BTM_BLE_LIMIT_DISC_FLAG | BTM_BLE_GEN_DISC_FLAG)) != 0)
            {
                BTM_TRACE_DEBUG("Find Generable Discoverable device");
                rt |= BTM_BLE_INQ_RESULT;
            }
            else
                if(btm_cb.btm_inq_vars.inq_active & BTM_BLE_LIMITED_INQUIRY &&
                        (flag & BTM_BLE_LIMIT_DISC_FLAG) != 0)
                {
                    BTM_TRACE_DEBUG("Find limited discoverable device");
                    rt |= BTM_BLE_INQ_RESULT;
                }
        }
    }

    return rt;
}

static void btm_ble_appearance_to_cod(uint16_t appearance, uint8_t *dev_class)
{
    dev_class[0] = 0;

    switch(appearance)
    {
        case BTM_BLE_APPEARANCE_GENERIC_PHONE:
            dev_class[1] = BTM_COD_MAJOR_PHONE;
            dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_COMPUTER:
            dev_class[1] = BTM_COD_MAJOR_COMPUTER;
            dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_REMOTE:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_REMOTE_CONTROL;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_THERMOMETER:
        case BTM_BLE_APPEARANCE_THERMOMETER_EAR:
            dev_class[1] = BTM_COD_MAJOR_HEALTH;
            dev_class[2] = BTM_COD_MINOR_THERMOMETER;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_HEART_RATE:
        case BTM_BLE_APPEARANCE_HEART_RATE_BELT:
            dev_class[1] = BTM_COD_MAJOR_HEALTH;
            dev_class[2] = BTM_COD_MINOR_HEART_PULSE_MONITOR;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_BLOOD_PRESSURE:
        case BTM_BLE_APPEARANCE_BLOOD_PRESSURE_ARM:
        case BTM_BLE_APPEARANCE_BLOOD_PRESSURE_WRIST:
            dev_class[1] = BTM_COD_MAJOR_HEALTH;
            dev_class[2] = BTM_COD_MINOR_BLOOD_MONITOR;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_PULSE_OXIMETER:
        case BTM_BLE_APPEARANCE_PULSE_OXIMETER_FINGERTIP:
        case BTM_BLE_APPEARANCE_PULSE_OXIMETER_WRIST:
            dev_class[1] = BTM_COD_MAJOR_HEALTH;
            dev_class[2] = BTM_COD_MINOR_PULSE_OXIMETER;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_GLUCOSE:
            dev_class[1] = BTM_COD_MAJOR_HEALTH;
            dev_class[2] = BTM_COD_MINOR_GLUCOSE_METER;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_WEIGHT:
            dev_class[1] = BTM_COD_MAJOR_HEALTH;
            dev_class[2] = BTM_COD_MINOR_WEIGHING_SCALE;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_WALKING:
        case BTM_BLE_APPEARANCE_WALKING_IN_SHOE:
        case BTM_BLE_APPEARANCE_WALKING_ON_SHOE:
        case BTM_BLE_APPEARANCE_WALKING_ON_HIP:
            dev_class[1] = BTM_COD_MAJOR_HEALTH;
            dev_class[2] = BTM_COD_MINOR_STEP_COUNTER;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_WATCH:
        case BTM_BLE_APPEARANCE_SPORTS_WATCH:
            dev_class[1] = BTM_COD_MAJOR_WEARABLE;
            dev_class[2] = BTM_COD_MINOR_WRIST_WATCH;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_EYEGLASSES:
            dev_class[1] = BTM_COD_MAJOR_WEARABLE;
            dev_class[2] = BTM_COD_MINOR_GLASSES;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_DISPLAY:
            dev_class[1] = BTM_COD_MAJOR_IMAGING;
            dev_class[2] = BTM_COD_MINOR_DISPLAY;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_MEDIA_PLAYER:
            dev_class[1] = BTM_COD_MAJOR_AUDIO;
            dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED;
            break;

        case BTM_BLE_APPEARANCE_GENERIC_BARCODE_SCANNER:
        case BTM_BLE_APPEARANCE_HID_BARCODE_SCANNER:
        case BTM_BLE_APPEARANCE_GENERIC_HID:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED;
            break;

        case BTM_BLE_APPEARANCE_HID_KEYBOARD:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_KEYBOARD;
            break;

        case BTM_BLE_APPEARANCE_HID_MOUSE:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_POINTING;
            break;

        case BTM_BLE_APPEARANCE_HID_JOYSTICK:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_JOYSTICK;
            break;

        case BTM_BLE_APPEARANCE_HID_GAMEPAD:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_GAMEPAD;
            break;

        case BTM_BLE_APPEARANCE_HID_DIGITIZER_TABLET:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_DIGITIZING_TABLET;
            break;

        case BTM_BLE_APPEARANCE_HID_CARD_READER:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_CARD_READER;
            break;

        case BTM_BLE_APPEARANCE_HID_DIGITAL_PEN:
            dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
            dev_class[2] = BTM_COD_MINOR_DIGITAL_PAN;
            break;

        case BTM_BLE_APPEARANCE_UKNOWN:
        case BTM_BLE_APPEARANCE_GENERIC_CLOCK:
        case BTM_BLE_APPEARANCE_GENERIC_TAG:
        case BTM_BLE_APPEARANCE_GENERIC_KEYRING:
        case BTM_BLE_APPEARANCE_GENERIC_CYCLING:
        case BTM_BLE_APPEARANCE_CYCLING_COMPUTER:
        case BTM_BLE_APPEARANCE_CYCLING_SPEED:
        case BTM_BLE_APPEARANCE_CYCLING_CADENCE:
        case BTM_BLE_APPEARANCE_CYCLING_POWER:
        case BTM_BLE_APPEARANCE_CYCLING_SPEED_CADENCE:
        case BTM_BLE_APPEARANCE_GENERIC_OUTDOOR_SPORTS:
        case BTM_BLE_APPEARANCE_OUTDOOR_SPORTS_LOCATION:
        case BTM_BLE_APPEARANCE_OUTDOOR_SPORTS_LOCATION_AND_NAV:
        case BTM_BLE_APPEARANCE_OUTDOOR_SPORTS_LOCATION_POD:
        case BTM_BLE_APPEARANCE_OUTDOOR_SPORTS_LOCATION_POD_AND_NAV:
        default:
            dev_class[1] = BTM_COD_MAJOR_UNCLASSIFIED;
            dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED;
    };
}

/*******************************************************************************
**
** Function         btm_ble_update_inq_result
**
** Description      Update adv packet information into inquiry result.
**
** Parameters
**
** Returns          void
**
*******************************************************************************/
uint8_t btm_ble_update_inq_result(tINQ_DB_ENT *p_i, uint8_t addr_type, uint8_t evt_type, uint8_t *p)
{
    uint8_t             to_report = TRUE;
    tBTM_INQ_RESULTS     *p_cur = &p_i->inq_info.results;
    uint8_t               len;
    uint8_t               *p_flag;
    tBTM_INQUIRY_VAR_ST  *p_inq = &btm_cb.btm_inq_vars;
    uint8_t                data_len, rssi;
    tBTM_BLE_INQ_CB     *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var;
    uint8_t *p1;
    uint8_t               *p_uuid16;
    STREAM_TO_UINT8(data_len, p);

    if(data_len > BTM_BLE_ADV_DATA_LEN_MAX)
    {
        BTM_TRACE_WARNING("EIR data too long %d. discard", data_len);
        return FALSE;
    }

    btm_ble_cache_adv_data(p_cur, data_len, p, evt_type);
    p1 = (p + data_len);
    STREAM_TO_UINT8(rssi, p1);
    /* Save the info */
    p_cur->inq_result_type = BTM_INQ_RESULT_BLE;
    p_cur->ble_addr_type    = addr_type;
    p_cur->rssi = rssi;

    /* active scan, always wait until get scan_rsp to report the result */
    if((btm_cb.ble_ctr_cb.inq_var.scan_type == BTM_BLE_SCAN_MODE_ACTI &&
            (evt_type == BTM_BLE_CONNECT_EVT || evt_type == BTM_BLE_DISCOVER_EVT)))
    {
        BTM_TRACE_DEBUG("btm_ble_update_inq_result scan_rsp=false, to_report=false,\
                              scan_type_active=%d", btm_cb.ble_ctr_cb.inq_var.scan_type);
        p_i->scan_rsp = FALSE;
        to_report = FALSE;
    }
    else
    {
        p_i->scan_rsp = TRUE;
    }

    if(p_i->inq_count != p_inq->inq_counter)
    {
        p_cur->device_type = BT_DEVICE_TYPE_BLE;
    }
    else
    {
        p_cur->device_type |= BT_DEVICE_TYPE_BLE;
    }

    if(evt_type != BTM_BLE_SCAN_RSP_EVT)
    {
        p_cur->ble_evt_type     = evt_type;
    }

    p_i->inq_count = p_inq->inq_counter;   /* Mark entry for current inquiry */

    if(p_le_inq_cb->adv_len != 0)
    {
        if((p_flag = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache, BTM_BLE_AD_TYPE_FLAG, &len)) != NULL)
        {
            p_cur->flag = * p_flag;
        }
    }

    if(p_le_inq_cb->adv_len != 0)
    {
        /* Check to see the BLE device has the Appearance UUID in the advertising data.  If it does
         * then try to convert the appearance value to a class of device value Bluedroid can use.
         * Otherwise fall back to trying to infer if it is a HID device based on the service class.
         */
        p_uuid16 = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache, BTM_BLE_AD_TYPE_APPEARANCE, &len);

        if(p_uuid16 && len == 2)
        {
            btm_ble_appearance_to_cod((uint16_t)p_uuid16[0] | (p_uuid16[1] << 8), p_cur->dev_class);
        }
        else
        {
            if((p_uuid16 = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache,
                                            BTM_BLE_AD_TYPE_16SRV_CMPL, &len)) != NULL)
            {
                uint8_t i;

                for(i = 0; i + 2 <= len; i = i + 2)
                {
                    /* if this BLE device support HID over LE, set HID Major in class of device */
                    if((p_uuid16[i] | (p_uuid16[i + 1] << 8)) == UUID_SERVCLASS_LE_HID)
                    {
                        p_cur->dev_class[0] = 0;
                        p_cur->dev_class[1] = BTM_COD_MAJOR_PERIPHERAL;
                        p_cur->dev_class[2] = 0;
                        break;
                    }
                }
            }
        }
    }

    /* if BR/EDR not supported is not set, assume is a DUMO device */
    if((p_cur->flag & BTM_BLE_BREDR_NOT_SPT) == 0 &&
            evt_type != BTM_BLE_CONNECT_DIR_EVT)
    {
        if(p_cur->ble_addr_type != BLE_ADDR_RANDOM)
        {
            BTM_TRACE_DEBUG("BR/EDR NOT support bit not set, treat as DUMO");
            p_cur->device_type |= BT_DEVICE_TYPE_DUMO;
        }
        else
        {
            BTM_TRACE_DEBUG("Random address, treating device as LE only");
        }
    }
    else
    {
        BTM_TRACE_DEBUG("BR/EDR NOT SUPPORT bit set, LE only device");
    }

    return to_report;
}

/*******************************************************************************
**
** Function         btm_clear_all_pending_le_entry
**
** Description      This function is called to clear all LE pending entry in
**                  inquiry database.
**
** Returns          void
**
*******************************************************************************/
void btm_clear_all_pending_le_entry(void)
{
    uint16_t       xx;
    tINQ_DB_ENT  *p_ent = btm_cb.btm_inq_vars.inq_db;

    for(xx = 0; xx < BTM_INQ_DB_SIZE; xx++, p_ent++)
    {
        /* mark all pending LE entry as unused if an LE only device has scan response outstanding */
        if((p_ent->in_use) &&
                (p_ent->inq_info.results.device_type == BT_DEVICE_TYPE_BLE) &&
                !p_ent->scan_rsp)
        {
            p_ent->in_use = FALSE;
        }
    }
}

/*******************************************************************************
**
** Function         btm_send_sel_conn_callback
**
** Description      send selection connection request callback.
**
** Parameters
**
** Returns          void
**
*******************************************************************************/
void btm_send_sel_conn_callback(BD_ADDR remote_bda, uint8_t evt_type, uint8_t *p_data, uint8_t addr_type)
{
    uint8_t   data_len, len;
    uint8_t   *p_dev_name, remname[31] = {0};
    UNUSED(addr_type);

    if(btm_cb.ble_ctr_cb.p_select_cback == NULL ||
            /* non-connectable device */
            (evt_type != BTM_BLE_EVT_CONN_ADV && evt_type != BTM_BLE_EVT_CONN_DIR_ADV))
    {
        return;
    }

    STREAM_TO_UINT8(data_len, p_data);

    /* get the device name if exist in ADV data */
    if(data_len != 0)
    {
        p_dev_name = BTM_CheckAdvData(p_data, BTM_BLE_AD_TYPE_NAME_CMPL, &len);

        if(p_dev_name == NULL)
        {
            p_dev_name = BTM_CheckAdvData(p_data, BTM_BLE_AD_TYPE_NAME_SHORT, &len);
        }

        if(p_dev_name)
        {
            wm_memcpy(remname, p_dev_name, len);
        }
    }

    /* allow connection */
    if((* btm_cb.ble_ctr_cb.p_select_cback)(remote_bda, remname))
    {
        /* terminate selective connection, initiate connection */
        btm_ble_initiate_select_conn(remote_bda);
    }
}

/*******************************************************************************
**
** Function         btm_ble_process_adv_pkt
**
** Description      This function is called when adv packet report events are
**                  received from the device. It updates the inquiry database.
**                  If the inquiry database is full, the oldest entry is discarded.
**
** Parameters
**
** Returns          void
**
*******************************************************************************/
void btm_ble_process_adv_pkt(uint8_t *p_data)
{
    BD_ADDR             bda;
    uint8_t               evt_type = 0, *p = p_data;
    uint8_t               addr_type = 0;
    uint8_t               num_reports;
    uint8_t               data_len;
    #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE)
    uint8_t             match = FALSE;
    #endif

    /* Only process the results if the inquiry is still active */
    if(!BTM_BLE_IS_SCAN_ACTIVE(btm_cb.ble_ctr_cb.scan_activity))
    {
        return;
    }

    /* Extract the number of reports in this event. */
    STREAM_TO_UINT8(num_reports, p);

    while(num_reports--)
    {
        /* Extract inquiry results */
        STREAM_TO_UINT8(evt_type, p);
        STREAM_TO_UINT8(addr_type, p);
        STREAM_TO_BDADDR(bda, p);
        #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE)
        /* map address to security record */
        match = btm_identity_addr_to_random_pseudo(bda, &addr_type, FALSE);
        BTM_TRACE_DEBUG("btm_ble_process_adv_pkt:bda= %0x:%0x:%0x:%0x:%0x:%0x",
                        bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);

        /* always do RRA resolution on host */
        if(!match && BTM_BLE_IS_RESOLVE_BDA(bda))
        {
            btm_ble_resolve_random_addr(bda, btm_ble_resolve_random_addr_on_adv, p_data);
        }
        else
        #endif
            btm_ble_process_adv_pkt_cont(bda, addr_type, evt_type, p);

        STREAM_TO_UINT8(data_len, p);
        /* Advance to the next event data_len + rssi byte */
        p += data_len + 1;
    }
}

/*******************************************************************************
**
** Function         btm_ble_process_adv_pkt_cont
**
** Description      This function is called after random address resolution is
**                  done, and proceed to process adv packet.
**
** Parameters
**
** Returns          void
**
*******************************************************************************/
static void btm_ble_process_adv_pkt_cont(BD_ADDR bda, uint8_t addr_type, uint8_t evt_type, uint8_t *p)
{
    tINQ_DB_ENT          *p_i;
    tBTM_INQUIRY_VAR_ST  *p_inq = &btm_cb.btm_inq_vars;
    tBTM_INQ_RESULTS_CB  *p_inq_results_cb = p_inq->p_inq_results_cb;
    tBTM_INQ_RESULTS_CB  *p_obs_results_cb = btm_cb.ble_ctr_cb.p_obs_results_cb;
    tBTM_BLE_INQ_CB      *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var;
    uint8_t     update = TRUE;
    uint8_t       result = 0;
    p_i = btm_inq_db_find(bda);

    /* Check if this address has already been processed for this inquiry */
    if(btm_inq_find_bdaddr(bda))
    {
        /* never been report as an LE device */
        if(p_i &&
                (!(p_i->inq_info.results.device_type & BT_DEVICE_TYPE_BLE) ||
                 /* scan repsonse to be updated */
                 (!p_i->scan_rsp)))
        {
            update = TRUE;
        }
        else
            if(BTM_BLE_IS_OBS_ACTIVE(btm_cb.ble_ctr_cb.scan_activity))
            {
                update = FALSE;
            }
            else
            {
                /* if yes, skip it */
                return; /* assumption: one result per event */
            }
    }

    /* If existing entry, use that, else get  a new one (possibly reusing the oldest) */
    if(p_i == NULL)
    {
        if((p_i = btm_inq_db_new(bda)) != NULL)
        {
            p_inq->inq_cmpl_info.num_resp++;
        }
        else
        {
            return;
        }
    }
    else
        if(p_i->inq_count != p_inq->inq_counter)   /* first time seen in this inquiry */
        {
            p_inq->inq_cmpl_info.num_resp++;
        }

    /* update the LE device information in inquiry database */
    if(!btm_ble_update_inq_result(p_i, addr_type, evt_type, p))
    {
        return;
    }

    if((result = btm_ble_is_discoverable(bda, evt_type, p)) == 0)
    {
        LOG_WARN(LOG_TAG, "%s device is no longer discoverable so discarding advertising packet pkt",
                 __func__);
        return;
    }

    if(!update)
    {
        result &= ~BTM_BLE_INQ_RESULT;
    }

    /* If the number of responses found and limited, issue a cancel inquiry */
    if(p_inq->inqparms.max_resps &&
            p_inq->inq_cmpl_info.num_resp == p_inq->inqparms.max_resps)
    {
        /* new device */
        if(p_i == NULL ||
                /* assume a DUMO device, BR/EDR inquiry is always active */
                (p_i &&
                 (p_i->inq_info.results.device_type & BT_DEVICE_TYPE_BLE) == BT_DEVICE_TYPE_BLE &&
                 p_i->scan_rsp))
        {
            BTM_TRACE_WARNING("INQ RES: Extra Response Received...cancelling inquiry..");

            /* if is non-periodic inquiry active, cancel now */
            if((p_inq->inq_active & BTM_BR_INQ_ACTIVE_MASK) != 0 &&
                    (p_inq->inq_active & BTM_PERIODIC_INQUIRY_ACTIVE) == 0)
            {
                btsnd_hcic_inq_cancel();
            }

            btm_ble_stop_inquiry();
            btm_acl_update_busy_level(BTM_BLI_INQ_DONE_EVT);
        }
    }

    /* background connection in selective connection mode */
    if(btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_SELECTIVE)
    {
        if(result & BTM_BLE_SEL_CONN_RESULT)
        {
            btm_send_sel_conn_callback(bda, evt_type, p, addr_type);
        }
        else
        {
            BTM_TRACE_DEBUG("None LE device, can not initiate selective connection");
        }
    }
    else
    {
        if(p_inq_results_cb && (result & BTM_BLE_INQ_RESULT))
        {
            (p_inq_results_cb)((tBTM_INQ_RESULTS *) &p_i->inq_info.results, p_le_inq_cb->adv_data_cache);
        }

        if(p_obs_results_cb && (result & BTM_BLE_OBS_RESULT))
        {
            (p_obs_results_cb)((tBTM_INQ_RESULTS *) &p_i->inq_info.results, p_le_inq_cb->adv_data_cache);
        }
    }
}

/*******************************************************************************
**
** Function         btm_ble_start_scan
**
** Description      Start the BLE scan.
**
** Returns          void
**
*******************************************************************************/
tBTM_STATUS btm_ble_start_scan(void)
{
    tBTM_BLE_INQ_CB *p_inq = &btm_cb.ble_ctr_cb.inq_var;
    tBTM_STATUS status = BTM_CMD_STARTED;

    /* start scan, disable duplicate filtering */
    if(!btsnd_hcic_ble_set_scan_enable(BTM_BLE_SCAN_ENABLE, p_inq->scan_duplicate_filter))
    {
        status = BTM_NO_RESOURCES;
    }
    else
    {
        if(p_inq->scan_type == BTM_BLE_SCAN_MODE_ACTI)
        {
            btm_ble_set_topology_mask(BTM_BLE_STATE_ACTIVE_SCAN_BIT);
        }
        else
        {
            btm_ble_set_topology_mask(BTM_BLE_STATE_PASSIVE_SCAN_BIT);
        }
    }

    return status;
}

/*******************************************************************************
**
** Function         btm_ble_stop_scan
**
** Description      Stop the BLE scan.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_stop_scan(void)
{
    BTM_TRACE_EVENT("btm_ble_stop_scan ");
    tBTM_BLE_INQ_CB *p_inq = &btm_cb.ble_ctr_cb.inq_var;

    if(p_inq->scan_type == BTM_BLE_SCAN_MODE_ACTI)
    {
        btm_ble_clear_topology_mask(BTM_BLE_STATE_ACTIVE_SCAN_BIT);
    }
    else
    {
        btm_ble_clear_topology_mask(BTM_BLE_STATE_PASSIVE_SCAN_BIT);
    }

    /* Clear the inquiry callback if set */
    btm_cb.ble_ctr_cb.inq_var.scan_type = BTM_BLE_SCAN_MODE_NONE;
    /* stop discovery now */
    btsnd_hcic_ble_set_scan_enable(BTM_BLE_SCAN_DISABLE, BTM_BLE_DUPLICATE_ENABLE);
    btm_update_scanner_filter_policy(SP_ADV_ALL);
    btm_cb.ble_ctr_cb.wl_state &= ~BTM_BLE_WL_SCAN;
}
/*******************************************************************************
**
** Function         btm_ble_stop_inquiry
**
** Description      Stop the BLE Inquiry.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_stop_inquiry(void)
{
    tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars;
    tBTM_BLE_CB *p_ble_cb = &btm_cb.ble_ctr_cb;
    #ifdef USE_ALARM
    alarm_cancel(p_ble_cb->inq_var.inquiry_timer);
    #else
    btu_stop_timer(&p_ble_cb->inq_var.inquiry_timer);
    #endif
    p_ble_cb->scan_activity &=  ~BTM_BLE_INQUIRY_MASK;

    /* If no more scan activity, stop LE scan now */
    if(!BTM_BLE_IS_SCAN_ACTIVE(p_ble_cb->scan_activity))
    {
        btm_ble_stop_scan();
    }
    else
        if((p_ble_cb->inq_var.scan_interval != BTM_BLE_LOW_LATENCY_SCAN_INT) ||
                (p_ble_cb->inq_var.scan_window != BTM_BLE_LOW_LATENCY_SCAN_WIN))
        {
            BTM_TRACE_DEBUG("%s: setting default params for ongoing observe", __FUNCTION__);
            btm_ble_stop_scan();
            btm_ble_start_scan();
        }

    /* If we have a callback registered for inquiry complete, call it */
    BTM_TRACE_DEBUG("BTM Inq Compl Callback: status 0x%02x, num results %d",
                    p_inq->inq_cmpl_info.status, p_inq->inq_cmpl_info.num_resp);
    btm_process_inq_complete(HCI_SUCCESS, (uint8_t)(p_inq->inqparms.mode & BTM_BLE_INQUIRY_MASK));
}

/*******************************************************************************
**
** Function         btm_ble_stop_observe
**
** Description      Stop the BLE Observe.
**
** Returns          void
**
*******************************************************************************/
static void btm_ble_stop_observe(void)
{
    tBTM_BLE_CB *p_ble_cb = & btm_cb.ble_ctr_cb;
    tBTM_CMPL_CB *p_obs_cb = p_ble_cb->p_obs_cmpl_cb;
    #ifdef USE_ALARM
    alarm_cancel(p_ble_cb->observer_timer);
    #else
    btu_stop_timer(&p_ble_cb->observer_timer);
    #endif
    p_ble_cb->scan_activity &= ~BTM_LE_OBSERVE_ACTIVE;
    p_ble_cb->p_obs_results_cb = NULL;
    p_ble_cb->p_obs_cmpl_cb = NULL;

    if(!BTM_BLE_IS_SCAN_ACTIVE(p_ble_cb->scan_activity))
    {
        btm_ble_stop_scan();
    }

    if(p_obs_cb)
    {
        (p_obs_cb)((tBTM_INQUIRY_CMPL *) &btm_cb.btm_inq_vars.inq_cmpl_info);
    }
}
/*******************************************************************************
**
** Function         btm_ble_adv_states_operation
**
** Description      Set or clear adv states in topology mask
**
** Returns          operation status. TRUE if sucessful, FALSE otherwise.
**
*******************************************************************************/
typedef uint8_t (BTM_TOPOLOGY_FUNC_PTR)(tBTM_BLE_STATE_MASK);
static uint8_t btm_ble_adv_states_operation(BTM_TOPOLOGY_FUNC_PTR *p_handler, uint8_t adv_evt)
{
    uint8_t rt = FALSE;

    switch(adv_evt)
    {
        case BTM_BLE_CONNECT_EVT:
            rt  = (*p_handler)(BTM_BLE_STATE_CONN_ADV_BIT);
            break;

        case  BTM_BLE_NON_CONNECT_EVT:
            rt  = (*p_handler)(BTM_BLE_STATE_NON_CONN_ADV_BIT);
            break;

        case BTM_BLE_CONNECT_DIR_EVT:
            rt  = (*p_handler)(BTM_BLE_STATE_HI_DUTY_DIR_ADV_BIT);
            break;

        case BTM_BLE_DISCOVER_EVT:
            rt  = (*p_handler)(BTM_BLE_STATE_SCAN_ADV_BIT);
            break;

        case BTM_BLE_CONNECT_LO_DUTY_DIR_EVT:
            rt = (*p_handler)(BTM_BLE_STATE_LO_DUTY_DIR_ADV_BIT);
            break;

        default:
            BTM_TRACE_ERROR("unknown adv event : %d", adv_evt);
            break;
    }

    return rt;
}

/*******************************************************************************
**
** Function         btm_ble_start_adv
**
** Description      start the BLE advertising.
**
** Returns          void
**
*******************************************************************************/
tBTM_STATUS btm_ble_start_adv(void)
{
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    tBTM_STATUS     rt = BTM_NO_RESOURCES;

    if(!btm_ble_adv_states_operation(btm_ble_topology_check, p_cb->evt_type))
    {
        return BTM_WRONG_MODE;
    }

    #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE)

    /* To relax resolving list,  always have resolving list enabled, unless directed adv */
    if(p_cb->evt_type != BTM_BLE_CONNECT_LO_DUTY_DIR_EVT &&
            p_cb->evt_type != BTM_BLE_CONNECT_DIR_EVT)
        /* enable resolving list is desired */
    {
        btm_ble_enable_resolving_list_for_platform(BTM_BLE_RL_ADV);
    }

    #endif

    if(p_cb->afp != AP_SCAN_CONN_ALL)
    {
        btm_execute_wl_dev_operation();
        btm_cb.ble_ctr_cb.wl_state |= BTM_BLE_WL_ADV;
    }

    if(btsnd_hcic_ble_set_adv_enable(BTM_BLE_ADV_ENABLE))
    {
        p_cb->adv_mode = BTM_BLE_ADV_ENABLE;
        btm_ble_adv_states_operation(btm_ble_set_topology_mask, p_cb->evt_type);
        rt = BTM_SUCCESS;
    }
    else
    {
        p_cb->adv_mode = BTM_BLE_ADV_DISABLE;
        btm_cb.ble_ctr_cb.wl_state &= ~BTM_BLE_WL_ADV;
    }

    return rt;
}

/*******************************************************************************
**
** Function         btm_ble_stop_adv
**
** Description      Stop the BLE advertising.
**
** Returns          void
**
*******************************************************************************/
tBTM_STATUS btm_ble_stop_adv(void)
{
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
    tBTM_STATUS rt = BTM_SUCCESS;

    if(p_cb->adv_mode == BTM_BLE_ADV_ENABLE)
    {
        if(btsnd_hcic_ble_set_adv_enable(BTM_BLE_ADV_DISABLE))
        {
            p_cb->fast_adv_on = FALSE;
            p_cb->broadcast_adv_timer_on = FALSE;
            p_cb->adv_mode = BTM_BLE_ADV_DISABLE;
            btm_cb.ble_ctr_cb.wl_state &= ~BTM_BLE_WL_ADV;
            /* clear all adv states */
            btm_ble_clear_topology_mask(BTM_BLE_STATE_ALL_ADV_MASK);
        }
        else
        {
            rt = BTM_NO_RESOURCES;
        }
    }

    return rt;
}

static void btm_ble_fast_adv_timer_timeout(void *data)
{
    /* fast adv is completed, fall back to slow adv interval */
    btm_ble_start_slow_adv();
}

/*******************************************************************************
**
** Function         btm_ble_start_slow_adv
**
** Description      Restart adv with slow adv interval
**
** Returns          void
**
*******************************************************************************/
static void btm_ble_start_slow_adv(void)
{
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;

    if(p_cb->adv_mode == BTM_BLE_ADV_ENABLE)
    {
        tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb;
        BD_ADDR p_addr_ptr = {0};
        tBLE_ADDR_TYPE init_addr_type = BLE_ADDR_PUBLIC;
        tBLE_ADDR_TYPE own_addr_type = p_addr_cb->own_addr_type;
        btm_ble_stop_adv();
        p_cb->evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &init_addr_type,
                         &own_addr_type);
        /* slow adv mode never goes into directed adv */
        btsnd_hcic_ble_write_adv_params(BTM_BLE_GAP_ADV_SLOW_INT, BTM_BLE_GAP_ADV_SLOW_INT,
                                        p_cb->evt_type, own_addr_type,
                                        init_addr_type, p_addr_ptr,
                                        p_cb->adv_chnl_map, p_cb->afp);
        btm_ble_start_adv();
    }
}

static void btm_ble_inquiry_timer_gap_limited_discovery_timeout(void *data)
{
    /* lim_timeout expired, limited discovery should exit now */
    btm_cb.btm_inq_vars.discoverable_mode &= ~BTM_BLE_LIMITED_DISCOVERABLE;
    btm_ble_set_adv_flag(btm_cb.btm_inq_vars.connectable_mode,
                         btm_cb.btm_inq_vars.discoverable_mode);
}

static void btm_ble_inquiry_timer_timeout(void *data)
{
    btm_ble_stop_inquiry();
}

static void btm_ble_observer_timer_timeout(void *data)
{
    btm_ble_stop_observe();
}

void btm_ble_adv_raddr_timer_timeout(void *data)
{
    if((btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type == BLE_ADDR_RANDOM) &&
            (BTM_BleMaxMultiAdvInstanceCount() > 0))
    {
        btm_ble_multi_adv_configure_rpa((tBTM_BLE_MULTI_ADV_INST *)data);
    }
}

void btm_ble_refresh_raddr_timer_timeout(UNUSED_ATTR void *data)
{
    if(btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type == BLE_ADDR_RANDOM)
    {
        /* refresh the random addr */
        btm_gen_resolvable_private_addr((void *)btm_gen_resolve_paddr_low);
    }
}

/*******************************************************************************
**
** Function         btm_ble_read_remote_features_complete
**
** Description      This function is called when the command complete message
**                  is received from the HCI for the read LE remote feature supported
**                  complete event.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_read_remote_features_complete(uint8_t *p)
{
    tACL_CONN        *p_acl_cb = &btm_cb.acl_db[0];
    uint16_t            handle;
    uint8_t             status;
    int               xx;
    STREAM_TO_UINT8(status, p);

    // if LE read remote feature failed for HCI_ERR_CONN_FAILED_ESTABLISHMENT,
    // expect disconnect complete to be received
    if(status != HCI_ERR_CONN_FAILED_ESTABLISHMENT)
    {
        STREAM_TO_UINT16(handle, p);

        /* Look up the connection by handle and copy features */
        for(xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_acl_cb++)
        {
            if((p_acl_cb->in_use) && (p_acl_cb->hci_handle == handle))
            {
                STREAM_TO_ARRAY(p_acl_cb->peer_le_features, p, BD_FEATURES_LEN);
                btsnd_hcic_rmt_ver_req(p_acl_cb->hci_handle);
                break;
            }
        }
    }
}

/*******************************************************************************
**
** Function         btm_ble_write_adv_enable_complete
**
** Description      This function process the write adv enable command complete.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_write_adv_enable_complete(uint8_t *p)
{
    tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;

    /* if write adv enable/disbale not succeed */
    if(*p != HCI_SUCCESS)
    {
        /* toggle back the adv mode */
        p_cb->adv_mode = !p_cb->adv_mode;
    }
}

/*******************************************************************************
**
** Function         btm_ble_dir_adv_tout
**
** Description      when directed adv time out
**
** Returns          void
**
*******************************************************************************/
void btm_ble_dir_adv_tout(void)
{
    btm_cb.ble_ctr_cb.inq_var.adv_mode = BTM_BLE_ADV_DISABLE;
    /* make device fall back into undirected adv mode by default */
    btm_cb.ble_ctr_cb.inq_var.directed_conn = FALSE;
}

/*******************************************************************************
**
** Function         btm_ble_set_topology_mask
**
** Description      set BLE topology mask
**
** Returns          TRUE is request is allowed, FALSE otherwise.
**
*******************************************************************************/
uint8_t btm_ble_set_topology_mask(tBTM_BLE_STATE_MASK request_state_mask)
{
    request_state_mask &= BTM_BLE_STATE_ALL_MASK;
    btm_cb.ble_ctr_cb.cur_states |= (request_state_mask & BTM_BLE_STATE_ALL_MASK);
    return TRUE;
}

/*******************************************************************************
**
** Function         btm_ble_clear_topology_mask
**
** Description      Clear BLE topology bit mask
**
** Returns          TRUE is request is allowed, FALSE otherwise.
**
*******************************************************************************/
uint8_t btm_ble_clear_topology_mask(tBTM_BLE_STATE_MASK request_state_mask)
{
    request_state_mask &= BTM_BLE_STATE_ALL_MASK;
    btm_cb.ble_ctr_cb.cur_states &= ~request_state_mask;
    return TRUE;
}

/*******************************************************************************
**
** Function         btm_ble_update_link_topology_mask
**
** Description      This function update the link topology mask
**
** Returns          void
**
*******************************************************************************/
void btm_ble_update_link_topology_mask(uint8_t link_role, uint8_t increase)
{
    btm_ble_clear_topology_mask(BTM_BLE_STATE_ALL_CONN_MASK);

    if(increase)
    {
        btm_cb.ble_ctr_cb.link_count[link_role]++;
    }
    else
        if(btm_cb.ble_ctr_cb.link_count[link_role] > 0)
        {
            btm_cb.ble_ctr_cb.link_count[link_role]--;
        }

    if(btm_cb.ble_ctr_cb.link_count[HCI_ROLE_MASTER])
    {
        btm_ble_set_topology_mask(BTM_BLE_STATE_MASTER_BIT);
    }

    if(btm_cb.ble_ctr_cb.link_count[HCI_ROLE_SLAVE])
    {
        btm_ble_set_topology_mask(BTM_BLE_STATE_SLAVE_BIT);
    }

    if(link_role == HCI_ROLE_SLAVE && increase)
    {
        btm_cb.ble_ctr_cb.inq_var.adv_mode = BTM_BLE_ADV_DISABLE;
        /* make device fall back into undirected adv mode by default */
        btm_cb.ble_ctr_cb.inq_var.directed_conn = BTM_BLE_CONNECT_EVT;
        /* clear all adv states */
        btm_ble_clear_topology_mask(BTM_BLE_STATE_ALL_ADV_MASK);
    }
}

/*******************************************************************************
**
** Function         btm_ble_update_mode_operation
**
** Description      This function update the GAP role operation when a link status
**                  is updated.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_update_mode_operation(uint8_t link_role, BD_ADDR bd_addr, uint8_t status)
{
    if(status == HCI_ERR_DIRECTED_ADVERTISING_TIMEOUT)
    {
        btm_cb.ble_ctr_cb.inq_var.adv_mode  = BTM_BLE_ADV_DISABLE;
        /* make device fall back into undirected adv mode by default */
        btm_cb.ble_ctr_cb.inq_var.directed_conn = BTM_BLE_CONNECT_EVT;
        /* clear all adv states */
        btm_ble_clear_topology_mask(BTM_BLE_STATE_ALL_ADV_MASK);
    }

    if(btm_cb.ble_ctr_cb.inq_var.connectable_mode == BTM_BLE_CONNECTABLE)
    {
		#if ENABLE_ADV_AUTO_MODE
        btm_ble_set_connectability(btm_cb.btm_inq_vars.connectable_mode |
                                   btm_cb.ble_ctr_cb.inq_var.connectable_mode);
		#else
		/*application will control adv mode itself*/
		#endif
    }

    /* when no connection is attempted, and controller is not rejecting last request
       due to resource limitation, start next direct connection or background connection
       now in order */
    if(btm_ble_get_conn_st() == BLE_CONN_IDLE && status != HCI_ERR_HOST_REJECT_RESOURCES &&
            !btm_send_pending_direct_conn())
    {
        btm_ble_resume_bg_conn();
    }
}

/*******************************************************************************
**
** Function         btm_ble_init
**
** Description      Initialize the control block variable values.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_init(void)
{
    tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb;
    BTM_TRACE_DEBUG("%s", __func__);
    #ifdef USE_ALARM
    alarm_free(p_cb->observer_timer);
    alarm_free(p_cb->inq_var.fast_adv_timer);
    #endif
    wm_memset(p_cb, 0, sizeof(tBTM_BLE_CB));
    wm_memset(&(btm_cb.cmn_ble_vsc_cb), 0, sizeof(tBTM_BLE_VSC_CB));
    btm_cb.cmn_ble_vsc_cb.values_read = FALSE;
    #ifdef USE_ALARM
    p_cb->observer_timer = alarm_new("btm_ble.observer_timer");
    #endif
    p_cb->cur_states       = 0;
    p_cb->conn_pending_q = fixed_queue_new(SIZE_MAX);
    p_cb->inq_var.adv_mode = BTM_BLE_ADV_DISABLE;
    p_cb->inq_var.scan_type = BTM_BLE_SCAN_MODE_NONE;
    p_cb->inq_var.adv_chnl_map = BTM_BLE_DEFAULT_ADV_CHNL_MAP;
    p_cb->inq_var.afp = BTM_BLE_DEFAULT_AFP;
    p_cb->inq_var.sfp = BTM_BLE_DEFAULT_SFP;
    p_cb->inq_var.connectable_mode = BTM_BLE_NON_CONNECTABLE;
    p_cb->inq_var.discoverable_mode = BTM_BLE_NON_DISCOVERABLE;
    #ifdef USE_ALARM
    p_cb->inq_var.fast_adv_timer = alarm_new("btm_ble_inq.fast_adv_timer");
    p_cb->inq_var.inquiry_timer = alarm_new("btm_ble_inq.inquiry_timer");
    #endif
    /* for background connection, reset connection params to be undefined */
    p_cb->scan_int = p_cb->scan_win = BTM_BLE_SCAN_PARAM_UNDEF;
    p_cb->inq_var.evt_type = BTM_BLE_NON_CONNECT_EVT;
    #ifdef USE_ALARM
    p_cb->addr_mgnt_cb.refresh_raddr_timer =
                    alarm_new("btm_ble_addr.refresh_raddr_timer");
    #endif
    #if BLE_VND_INCLUDED == FALSE
    btm_ble_adv_filter_init();
    #endif
}
/*******************************************************************************
**
** Function         btm_ble_free
**
** Description      free the control block variable values.
**
** Returns          void
**
*******************************************************************************/
void btm_ble_free (void)
{
    tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb;

    BTM_TRACE_DEBUG("%s", __func__);

    fixed_queue_free(p_cb->conn_pending_q, GKI_freebuf);
}

/*******************************************************************************
**
** Function         btm_ble_topology_check
**
** Description      check to see requested state is supported. One state check at
**                  a time is supported
**
** Returns          TRUE is request is allowed, FALSE otherwise.
**
*******************************************************************************/
uint8_t btm_ble_topology_check(tBTM_BLE_STATE_MASK request_state_mask)
{
    uint8_t rt = FALSE;
    uint8_t   state_offset = 0;
    uint16_t  cur_states = btm_cb.ble_ctr_cb.cur_states;
    uint8_t   mask, offset;
    uint8_t   request_state = 0;

    /* check only one bit is set and within valid range */
    if(request_state_mask == BTM_BLE_STATE_INVALID ||
            request_state_mask > BTM_BLE_STATE_SCAN_ADV_BIT ||
            (request_state_mask & (request_state_mask - 1)) != 0)
    {
        BTM_TRACE_ERROR("illegal state requested: %d", request_state_mask);
        return rt;
    }

    while(request_state_mask)
    {
        request_state_mask >>= 1;
        request_state ++;
    }
    
    /* check if the requested state is supported or not */
    mask = btm_le_state_combo_tbl[0][request_state - 1][0];
    offset = btm_le_state_combo_tbl[0][request_state - 1][1];

    if(!BTM_LE_STATES_SUPPORTED(btm_cb.devcb.le_supported_states, mask, offset))
    {
        BTM_TRACE_ERROR("state requested not supported: %d", request_state);
        return rt;
    }

    rt = TRUE;

    /* make sure currently active states are all supported in conjunction with the requested
       state. If the bit in table is not set, the combination is not supported */
    while(cur_states != 0)
    {
        if(cur_states & 0x01)
        {
            mask = btm_le_state_combo_tbl[request_state][state_offset][0];
            offset = btm_le_state_combo_tbl[request_state][state_offset][1];

            if(mask != 0 && offset != 0)
            {
                if(!BTM_LE_STATES_SUPPORTED(btm_cb.devcb.le_supported_states, mask, offset))
                {
                    rt = FALSE;
                    break;
                }
            }
        }

        cur_states >>= 1;
        state_offset ++;
    }

    return rt;
}

#endif  /* BLE_INCLUDED */
